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(54) METHOD OF ESTIMATING FLOOR REACTIONS OF BIPEDAL WALKING BODY; AND METHOD 
OF ESTIMATING JOINT MOMENTS OF BIPEDAL WALKING BODY 



(57) Whether a motion star* of leg bodies 2 is a sin- 
gle stance state or a double ste nee state is sequentially 
determined and a total reactior force F is estimated on 
the basis of an equation of mot on for a center of gravity 
(GO) of a bipedal walking body 1 . If the motion state is 
the single stance state, then the estimated value of the 
total floor reaction force F is directly used as an estimat- 
ed value of the floor reaction force of the leg body 2. If 
the motion state is the double 5 tance state, then a floor 
reaction force Fr of the leg bedy 2 at the rear side is 
determined, using measurement data of elapsed time 
of the double stance state and moving speed of a bi- 
pedal walking body 1 and pre-e stablished characteristic 
data, and the floor reaction for^e Fr is subtracted from 
the total floor reaction force F t« > determine a floor reac- 
tion force Ff of the leg body 2 «it the front side. Thus, it 
<t— is possible to provide a method :hat allows floor reaction 
forces acting on leg bodies of a bipedal walking body, 
£\j such as a human being, and rr oments acting on joints 
1^ of the leg bodies to be determined in real time with high 
T "" accuracy by a relatively simple technique. 
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Description 

TECHNICAL FIELD 

5 [0001] The present invention i elates to a method of estimating floor reaction forces acting on leg bodies of a bipedal 
walking body, such as a humar being, a bipedal walking robot or the like. The present invention further relates to a 
method of estimating moments c ding on joints of a leg body of a bipedal walking body by using the aforesaid estimated 
values of the floor reaction forces. 

10 BACKGROUND ART 

[0002] To control an operation of, for example, a walking assisting apparatus for aiding a human being in walking or 
to control traveling motions of 8 bipedal walking robot, it is necessary to sequentially determine floor reaction forces 
acting on leg bodies of the human being or the bipedal walking robot (to be more specific, the forces from a floor that 
15 act on grounding portions of the legbodies). Determiningthefloor reaction forces makes it possible to acquire moments 
or the like acting on joints of the leg bodies of the bipedal walking body, and to decide target auxiliary forces of the 
walking assisting apparatus or desired drive torques or the like of joints of the bipedal walking robot on the basis of 
the determined moments or the like. 

[0003] As a technique for determining the floor reaction forces, one disclosed in, for example, Japanese Unexamined 
20 Patent Application Publication No. 2000-249570 has been known. According to this technique, a floor reaction force 
of each leg body is defined as a resultant value (linear combination) of a plurality of trigonometric functions having 
mutually different cycles of 1/n (n = 1, 2, ...) of a walking cycle, because time-dependent change waveforms of floor 
reaction forces of each leg body periodically change during steady walking of a bipedal walking body. In this case, 
weighting factors of the trigonon metric functions for combining the plurality of trigonometric functions use predetermined 
25 values preset for each bipedal w alking body or values obtained by adjusting the preset predetermined values according 
to topography. 

[0004] However, the foregoin 3 technique is adapted to determine floor reaction forces of the leg bodies for one step 
or a plurality of steps of the bipadal walking body. For this reason, it is difficult to accurately determine floor reaction 
forces if the gait of the bipedal w alking body sequentially changes. Furthermore, to enhance the accuracy of determined 
30 floor reaction forces, the weighl ing factors of the trigonometric functions must be set for each bipedal walking body or 
adjusted according to topology or the like. This makes it difficult to accurately determine floor reaction forces by min- 
imizing influences of environme nts under which bipedal walking bodies move or individual differences among bipedal 
walking bodies. 

[0005] There has been known, tor example, a bipedal walking robot having force sensors, such as six-axis force 
35 sensors, attached to ankles anc foot portions of each leg body to determine floor reaction forces on the basis of outputs 
of the force sensors. There has been known another technique whereby a bipedal walking body is walked on a force 
plate installed on a floor to det£ rmine floor reaction forces from the outputs of the force plate. 

[0006] According to the techi iojogy using force sensors, however, in order to determine the floor reaction forces of 
human leg bodies, in particular, Force sensors have to be attached to ankles and foot portions, so that the force sensors 
40 inconveniently interfere with walking in normal living environments. The technology using force plates allows floor 
reaction forces to be determined only in environments wherein the force plates are installed. 

[0007] The present inventior has been made with a view of the aforementioned background, and it is an object 
thereof to provide a method of < estimating floor reactions that permits floor reaction forces to be accurately determined 
in real time by a relatively simple technique and that is ideally suited for determining floor reaction forces of human 
45 beings, in particular, as bipedal walking bodies. 

[0008] It is a further object o : the present invention to provide a method of estimating joint moments of a bipedal 
walking body that allows moments acting on joints, such knee joints, of leg bodies to be accurately determined in real 
time by using an estimated value of a floor reaction force thereof, 

50 DISCLOSURE OF INVENTION 

[0009] First, a basic concept of the method of estimating floor reaction forces of a bipedal walking body in accordance 
with the present invention will be explained. 

[0010] Motion states of leg bodies of a bipedal walking body (motion states of the leg bodies during walking) include 
55 a single stance state in which only one leg body 2 (the front leg body in relation to the direction of travel in the figure) 
of both leg bodies 2 and 2 of a bipedal walking body 1 is in contact with the ground, as illustrated in Fig. 1(a), and a 
double stance state in which both leg bodies 2 and 2 are in contact with the ground, as shown in Fig. 1 (b). 
[001 1 ] If a total floor reaction force acting on the two leg bodies 2 and 2 from a floor A is denoted by F, then the total 
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floor reaction force F is equal tc the floor reaction force acting on the leg body 2 in contact with the ground in the single 
stance state shown in Fig 1 (a), while it is a resultant force of floor reaction forces Ff and Fr acting on the two leg bodies 
2 and 2. respectively, in the dcuble stance state shown in Fig. 2(a). if components in an X-axis direction (horizontal 
direction in relation to the direction of travel of the bipedal walking body 2) and in a Z-axis direction (vertical direction) 
of an acceleration a of a centei of gravity GO of the bipedal walking body 1 in an absolute coordinate system Cf fixed 
with respecL to the ground are jenoled by ax and az. respectively, and components in the X-axis direction and theZ- 
axis direction of the total floor reaction force F acting on the bipedal walking body 1 are denoted by Fx and Fz, respec- 
tively ; then an equation of motion of the center of gravity GO (more specifically, an equation of motion related to trans- 
lational motion of the center of gravity GO) is represented by an expression (1) below: 

T (Fx, Fz - M • g) = M • T (ax, az) (1) 

(where M: Weight of the bipedal walking body; g: Gravitational acceleration) 
[0012] The parenthesized part T ( , ) of both sides in expression (1) means a two-component vector. In the present 
description, the symbol T ( , ) denotes a vector. 

[0013] In other words, the eouation of motion of the center of gravity GO is a relational expression indicating that a 
product of the acceleration acta center of gravity GO and the weight M of the bipedal walking body 1 is equal to a 
resultant force of a gravity acting on the center of gravity GO (= M-g) and the total floor reaction force F. 
[0014] Therefore, if the acce eration a= T (ax, az) of the center of gravity GO of the bipedal walking body 1 is deter- 
mined, then an estimated value ! of the total floor reaction force F = T (Fx ; Fz) can be obtained by expression (2) given 
below, using the aforesaid acc eleration a, the value of the weight M of the bipedal walking body 1 , and the value of 
the gravitational acceleration g; 

T (Fx, Fz) = M • T (ax, az+g) (2) 

[0015] In the single stance state shown in Fig. 1(a), the floor reaction force acting on the single leg body 2 in contact 
with the ground is equal to the foregoing total floor reaction force F, so that an estimated value of the floor reaction 
force F acting on the single lec body 2 will be obtained by expression (2). 

[0016] In this case, the weight M necessary to obtain an estimated value of the floor reaction force F can be known 
in advance by measurement o the like. As will be discussed in detail hereinafter the position of the center of gravity 
GO and the acceleration a can )e sequentially determined by a publicly known techniques or the like, using outputs of 
sensors, such as a sensor for < electing a bending angle (rotational angle) of each joint of the bipedal walking body 1 , 
an accelerometer, a gyro sensor, and the like. 

[001 7] Meanwhile : regarding the double stance state shown in Fig. 1 (b), a floor reaction force acting on the leg body 
2 at the rear in relation to the c irection of travel of the bipedal walking body 1 is expressed as Fr= T (Frx, Frz), while a 
floor reaction force acting on th * leg body 2 at the front is expressed as Ff= T (Ffx, Ffz). At this time, as will be discussed 
in detail later, according to the knowledge of the inventors of the present application, the components Frx and Frz of 
the floor reaction force Fr acting on the rear leg body 2, in particular, exhibit characteristic changes having marked 
correlation with respect to the time elapsed from the start of the double stance state and the moving speed of the 
bipedal walking body 1 . Theref )re, preparing characteristic data representing such characteristics (maps, data tables, 
approximate function expressions, or the like) by performing various experiments, simulations and the like makes it 
possible to estimate the floor re action force Fr acting on the rear leg body 2 on the basis of the characteristic data. The 
resulting force of the floor reac;ion force Fr acting on the rear leg body 2 and the floor reaction force Ff acting on the 
front leg body 2 provides the toral floor reaction force F obtained by the foregoing expression (2). Hence, as shown by 
expression (3) below, an estimated value of the floor reaction force Ff acting on the front leg body 2 can be determined 
by subtracting the estimated value of the floor reaction force Fr acting on the rear leg body 2 determined on the basis 
of the characteristic data described above from the estimated value of thetotal floor reaction force F (vector subtraction). 

Ff - F-Fr - T (Fx - Frx, Fz - Frz) (3) 

[001 8] Accordingly, in the dot ble stance state, if the moving speed of the bipedal walking body 1 and the time elapsed 
from the start of the double stence state are determined, then estimated values of the floor reaction forces Fr and Ff 
of the two leg bodies 2 can be determined, using the above measured values and an estimated value of the total floor 
reaction force F In this case, th 3 moving speed of the bipedal walking body 1 can be determined by, for example, using 
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measurement data or the like Df tilt angles of a thigh and a cms of each leg body 2. as will be described in detail 
hereinafter. 

[0019] Based on the explanation above, the present invention will now be explained. To fulfill the foregoing objects, 
a method of estimating floor reactions of a bipedal walking body, that is, a method of estimating floor reaction forces 

5 acting on individual leg bodies < >f the bipedal walking body, includes a first step for determining whether a motion state 
of leg bodies of the bipedal wa <ing body is a single stance state wherein only one of the leg bodies is in contact with 
the ground or a double stance Mate wherein both leg bodies are in contact with the ground: a second step for sequen- 
tially determining positions of he center of gravity of the bipedal walking body while also sequentially determining 
accelerations of the centers of gravity in an absolute coordinate system fixed with respect to the ground, using time- 

10 series data of the positions of t \e centers of gravity; a third step for sequentially determining estimated values of total 
floor reaction force on the basis of an equation of motion of the centers of gravity represented by a weight of the bipedal 
walking body a gravitational acceleration, the accelerations of the centers of gravity, and a total floor reaction force, 
which is a resultant force of the floor reaction forces acting on the respective leg bodies; a fourth step for sequentially 
measuring time elapses from a start of the double stance state until an end thereof each time the double stance state 

'5 begins: and a fifth step for measuring a moving speed of the bipedal walking body at least before each double stance 
state is begun. Furthermore, a method of present invention comprises the steps of sequentially determining estimated 
values of the total floor reaction force as estimated values of floor reaction forces acting on a single leg body in contact 
with the ground when the bipedal walking body is in the single stance state, and sequentially determining estimated 
values of floor reaction forces acting on one of the two leg bodies, the one leg body being located at the rear side in 

20 relation to the direction of travel of the bipedal walking body, on the basis of characteristic data pre-established as 
indicative of characteristics of changes in floor reaction force acting on the above one leg body with respect to the 
elapsed time of the double stance state and moving speed of the bipedal walking body, and sequentially determine 
estimated values of the floor reaction forces acting on the other leg body when the bipedal walking body is in the double 
stance state by subtracting the determined estimated values of the floor reaction forces of the one leg body from the 

25 estimated values of the total floor reaction force. 

[0020] According to the present invention, in the third step, estimated values of the total floor reaction force are 
sequentially determined (refer o expression (2)) according to the aforementioned equation of motion of the center of 
gravity of the bipedal walking oody (refer to expression (1)) on the basis of values of the weight, the gravitational 
acceleration and the center of j jravity acceleration of the bipedal walking body. Then, in the first step, it is determined 

30 whether the motion states of ti e leg bodies of the bipedal walking body are in the single stance state or the double 
stance state, and estimated va ues of the floor reaction forces aire determined by techniques based on the respective 
support states. More specifical /, in the single stance state of the bipedal walking body, an estimated value of the total 
floor reaction force directly pro\ ides an estimated value of the floor reaction force acting on a single leg body in contact 
with the ground. At this time, th 5 floor reaction force acting on the leg body not in contact with the ground (the free leg) 

35 is "^ero." 

[0021 ] I n the double stance s tate of the bipedal walking body, an estimated value of a floor reaction force acting on 
one leg body located at the reer side in relation to the direction of travel of the bipedal walking body is determined on 
the basis of the aforementionec characteristic data, using measurement data of time elapsed from a start of the double 
stance state and measurement data of the moving speed of the bipedal walking body. Furthermore, an estimated value 
40 of the floor reaction force actirg on the other leg body is determined by subtracting the estimated value of the floor 
reaction force of the foregoing >ne leg body from an estimated value of the total floor reaction force determined in the 
third step (performing vector si btraction) (refer to expression (3)). 

[0022] According to the present invention, an estimated value of the total floor reaction force is used to determine a 
floor reaction force acting on each leg body in both the single stance state and the double stance state. The weight of 

45 the bipedal walking body nece* sary to determine an estimated value of the total floor reaction force may be obtained 
beforehand by measurement o the like. The positions of center of gravity and the accelerations of the bipedal walking 
body can be determined in real time, using data of outputs of relatively small sensors that can be easily attached to a 
bipedal walking body, such as i sensor (potentiometer or the like) for detecting bending angles (rotational angles) of 
each joint of the bipedal walking body, and an accelerometer, a gyro sensor, and the like. 

so [0023] Thus, the method of estimating floor reactions in accordance with the present invention makes it possible to 
determine floor reaction forces n real time by a relatively simple technique without the need for attaching force sensors 
to ankles and foot portions of a bipedal walking body or using a force plate. 

[0024] In the method for estimating floor reaction forces in accordance with the present invention, the characteristic 
data is, for example, the data indicating a relationship between a ratio of a floor reaction force of the one leg body to 
55 the total floor reaction force at a start of the double stance state and a ratio of the elapsed time to a duration from a 
start to an end of the double stance state, a duration of the double stance state is estimated from a measured value 
of the moving speed on the basis of a pre-established correlation between the moving speed of the bipedal walking 
body and the duration of the double stance state, and an estimated value of a floor reaction force acting on the one 
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leg is sequentially determined cn the basis of the estimated value of the duration of the double stance state, a measured 
value of the elapsed time, an estimated value of the total floor reaction force at the start of the double stance state, 
and the characteristic data. 

[0025] More specifically, acording to the knowledge of the inventors of the present application, if attentions are 
5 focused on the relationship between a ratio of a floor reaction force of the one leg body (the leg body at the rear side 
in relation to the direction of tra/el of the bipedal walking body) with respect to the total floor reaction force at the start 
of the double stance state and . . ratio of the elapsed time with respect to a duration from a start to an end of the double 
stance state, then the ratio of tl e floor reaction force exhibits a substantially constant change with respect to the ratio 
of the elapsed time, regardless of the moving speed or the like of the bipedal walking body. Hence, characteristic data 
10 can be easily set by defining tho characteristic data as the data representing the relationship between the ratio of floor 
reaction forces and the ratio of elapsed time described above. 

[0026] In this case, the durat on of the double stance state, which provides a reference of the ratio of elapsed time, 
changes with the moving spee< I of the bipedal walking body. If the moving speed remains constant, then the duration 
of the double stance state will fc e substantially constant. Accordingly, establishing beforehand the correlation between 
15 the moving speed and the duration of the double stance state makes it possible to properly estimate the duration of 
the double stance state on the basis of the correlation from a measured value of the moving speed. The total floor 
reaction force, which provides a reference of the ratio of floor reaction force acting on the one leg body, is estimated 
on the basis of an equation of motion of the center of gravity of the bipedal walking body 

[0027] Therefore, to estimate the floor reaction forces of the respective leg bodies in the double stance state, as 
20 described above, the characteristic data is established as the correlation data between a ratio of the floor reaction 
forces of the one leg body based on the total floor reaction force at the start of the double stance state and a ratio of 
the elapsed time based on the duration of the double stance state, and an estimated value of the duration of the double 
stance state, which is determined from a measured value of the moving speed, a measured value of the elapsed time 
of the double stance state, and an estimated value of the total floor reaction force at the start of the double stance state 
25 are applied with the aforesaid characteristic data. This makes it possible to properly determine with high accuracy an 
estimated value of the floor reaction force acting on the one leg body. 

[0028] Floor reaction forces ire vector quantities. To be more specific, therefore, a ratio of the floor reaction force 
of the one leg body to the total floor reaction force is a ratio of each component of the floor reaction force in a certain 
appropriate coordinate system (e.g. , a coordinate system fixed with respect to a floor on which a bipedal walking body 
30 moves). 

[0029] A method of estimatin j floor reactions in accordance with the present invention includes, to measure a moving 
speed of a bipedal walking bod / in the fifth step, the steps of measuring a tilt angle of a cms under a knee joint of each 
leg body of the bipedal walkinc body and a tilt angle of a thigh between a hip joint and a knee joint of the leg body at 
a start of each double stance * tate, a step for calculating, at a start of each double stance state, a shift amount of a 

35 position of a bottom end portio i of the cms of the leg body with respect to the hip joint of the leg body existing at the 
rear side in relation to the direc tion of travel of the bipedal walking body, the shift taking place in the direction of travel 
of the bipedal walking body froi n the start of the preceding double stance state, on the basis of measured values of tilt 
angles of the thigh and the crui ; of the leg body and predetermined sizes of the thigh and the crus of the leg body, and 
measuring the time elapsed frDm a start of each double stance state to a start of the next double stance state as 

40 elapsed time for one step. In t le fifth step, each time the double stance state begins, the shift amount calculated at 
the start is divided by the one-s tep elapsed time measured from a start of the preceding double stance state to a start 
of the present double stance s ate so as to determine a measured value of the moving speed. 

[0030] More specifically, an j imount of a shift in the position. of a bottom end portion of the crus of the leg body with 
respect to the hip joint of the le 3 body (this leg body being the one in contact with the ground in the single stance state 

45 immediately before each doubl 3 stance state begins) existing at the rear side in relation to the direction of travel of the 
bipedal walking body at a start >f each doubie stance state, the shift taking place in the direction of travel of the bipedal 
walking body from the start of t ^e preceding double stance state will be the amount of distance over which the hip joint 
of the leg body (a proximal end portion of the leg body) has moved per step from a start of the preceding double stance 
state to a start of the present double stance state. Accordingly, an average moving speed of the bipedal walking body 

50 during the one-step elapsed time will be determined by dividing the aforesaid shift amount by the aforesaid one-step 
elapsed time, which is the time elapses from the start of the preceding double stance state to the start of the present 
double stance state. In this cas*:j, the shift amount can be determined by geometric computation using measured values 
of tilt angles of the thigh and the crus, respectively, of the leg body, which exists atthe rear side when the double stance 
state begins, the tilt angles being measured at the starts of the present and the preceding double stance states, and 

55 data of the sizes (to be more specific, the lengths) of the thigh and the crus. Furthermore, the tilt angles of the thigh 
and the crus of each leg body can be measured using a sensor for detecting bending angles of joints of leg bodies or 
other sensors, such as an accelerometer, and a gyro sensor. 

[0031] Thus, the moving speed of the bipedal walking body that is required for determining an estimated value of a 
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floor reaction force acting on etch leg body in the double stance state can be easily measured without using a large 
sensor or the like. Moreover tr e moving speed measured is the moving speed immediately before a start of each 
double stance state : so that the reliability can be improved, eventually permitting higher accuracy of estimated values 
of floor reaction forces in the dc uble stance state to be achieved. 

5 [0032] Furthermore, the meth )d of estimating floor reactions in accordance with the present invention comprises the 
steps of sequentially measuring vertical accelerations of a lower portion of a Lorso. which is adjacent to a hip joint, the 
torso being supported on the two leg bodies through the intermediary of hip joints of the leg bodies, wherein a motion 
state of the bipedal walking bo iy is determined in the first step as follows. It is determined as the beginning of the 
double stance state and the end of the single stance state when the vertical acceleration of the lower portion of the 

10 torso increases to a predetermined threshold value or more, whereas it is determined as the end of the double stance 
state and the beginning of the s ngle stance state when an estimated value of the floor reaction force acting on the leg 
body located at the rear side in elation to the direction of travel of the bipedal walking body in tho double stance state 
decreases to a predetermined threshold value or less. 

[0033] Alternatively, especiall t regarding the determination of an end of the double stance state (a start of the single 
15 stance state), according to the present invention for estimating the duration of the double stance state, as described 
above, a motion state of the t>ip >dal walking body may be determined that the double stance state ends and the single 
stance state begins when a mea sured value of elapsed time from a start of the double stance state reaches an estimated 
value of a duration of the doubl > stance state. 

[0034] More specifically, whil i the bipedal walking body is moving (walking), when a motion state of the leg body 
20 switches from the single stance state to the double stance state, a vertical acceleration (upward acceleration) of the 
lower portion of the torso tempo arily increases by a great extent when a leg body on a free leg side touches the ground. 
This phenomenon usually does not take place in other motion states of the leg bodies. Hence, comparing the accel- 
eration with a predetermined thr ishold value (relatively large threshold value) makes it possible to accurately determine 
an end of the single stance stat 3 and a start of the double stance state, 
25 [0035] When the motion states of leg bodies switch from the double stance state to the single stance state, the 
moment one leg body leaves a f oor, the floor reaction force acting on that leg body reduces to zero. Hence, comparing 
the floor reaction force acting cn the leg body with a predetermined threshold value (e.g., a threshold value slightly 
larger than zero) makes it poss ble to properly determine an end of the double stance state and a start of the single 
stance state. Especially when estimating a duration of the double stance state, the time elapsed from a start of the 
30 double stance state reaches an estimated value of the duration when a motion state of the leg body switches from the 
double stance state to the sing e stance state, thus allowing the end of the double stance state and the start of the 
single stance state to be accun tely determined. 

[0036] As discussed above, determining a motion state of leg bodies makes it possible to accurately determine 
whether the motion state is the single stance state or the double stance state. As a result, it is possible to switch, at a 

35 precise timing, between methoc s for calculating estimated values of floor reaction forces that differ between the single 
stance state and the double stance state, leading to higher accuracy of the estimated values of floor reaction forces. 
A vertical acceleration of a low* r portion of a torso that is necessary to determine motion states of the leg bodies can 
be easily known from outputs o , for example, an accelerometer attached to the lower portion of the torso. 
[0037] In the case of a huma l being or the like, in which a torso has a waist connected to both leg bodies through 

40 the intermediary of hip joints an i a chest located above the waist such that it can be inclined with respect to the waist, 
the vertical acceleration of the ic wer portion of the torso to be measured is preferably a vertical acceleration of the waist. 
[0038] In a method for estimating floor reactions in accordance with the present invention, various methods are 
conceivable and various public y known methods can be used for determining a position of the center of gravity and 
an acceleration of the center of gravity of a bipedal walking body in the aforesaid second step. It is preferred, however, 

45 to determine the position of the center of gravity and the acceleration of the center of gravity according to the following 
method. 

[0039] The method comprises the steps of sequentially measuring tilt angies of a torso supported on the two leg 
bodies through the intermediary of hip joints of the respective leg bodies, bending angles of at least hip joints and knee 
joints of the respective leg bodies, and accelerations of a predetermined reference point of the bipedal walking body 

50 in the absolute coordinate syste m, wherein in the second step, positions of the center of gravity of the bipedal walking 
body with respect to the referei ce point are sequentially determined on the basis of a tilt angle of the torso, bending 
angles of the hip joints and the knee joints, a rigid body link model representing the bipedal walking body in the form 
of a link assembly of a plurality >f rigid bodies, pre-acquired weights of individual portions of the bipedal walking body, 
which correspond to individual igid bodies of the rigid body link model, and the pre-acquired positions of the centers 

55 of gravity of the portions corresponding to rigid bodies in the respective portions corresponding to rigid bodies, accel- 
erations of the center of gravity with respect to the reference point are sequentially determined on the basis of time- 
series data of the positions of center of gravity, and accelerations of the center of gravity in the absolute coordinate 
system are determined from tr e accelerations of the center of gravity with respect to the reference point and the 
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accelerations of the reference p oint in the absolute coordinate system. 

[0040] When a reference po it is arbitrarily set in the bipedal walking body, a position of center of gravity of the 
bipedal walking body with respe ct to the reference point is generally decided by a mutual relationship among postures 
of a torso, thighs from hip joints to knee joints of respective leg bodies, and cruses under the knee joints. The posture 

s relationship can be known from measurement data obtained by measuring tilt angles of the torso and bending angles 
of the hip joints and the knee joints. As will be discussed in detail hereinafter, if the aforesaid rigid body link model (e. 
g., a model assuming that an i pper portion (including a torso) of the hip joints of the two leg bodies of the bipedal 
walking body, the thighs of the respective leg bodies, and the cruses as rigid bodies) is assumed, then a position of 
the center of gravity of the bipe ial walking body with respect to the reference point can be determined on the basis of 

10 the weights of the portions corr esponding to the rigid bodies of the bipedal walking body, the positions of the centers 
of gravity of the portions corresponding to the rigid bodies in the portions corresponding to the rigid bodies (to be more 
specific, the positions of the pcrtions corresponding to the rigid bodies in a coordinate system fixed for the portions 
corresponding to the rigid bodies), and the aforementioned posture relationship. Furthermore, the accelerations of the 
center of gravity with respect tc the reference point can be determined as two-level differential values of the positions 

75 of center of gravity obtained frc m the time-series data of the positions of center of gravity. Hence, by measuring the 
accelerations of the reference point in the absolute coordinate system beforehand, the accelerations of the center of 
gravity of the bipedal walking be dy in the absolute coordinate system are determined in terms of resultant accelerations 
of the accelerations of the cent n of gravity with respect to the reference point and the accelerations of the reference 
point. 

20 [0041] In this case, the tilt an jles of the torso necessary to determine the accelerations of the bipedal walking body 
can be determined from outputs of an accelerometer and a gyro sensor attached to the torso and another sensor, such 
as an inclinometer, as described above, and the bending angles of the hip joints and knee joints of the respective leg 
bodies can be determined from outputs of a sensor, such as a potentiometer, attached to the locations of the respective 
joints. Furthermore, the accele ations of the reference point in the absolute coordinate system can be obtained from 

25 outputs of a sensor, such as ar accelerometer, attached to a portion integral with the reference point. In addition, the 
weights of the portions corresponding to individual rigid bodies of the bipedal walking body and the positions of the 
center of gravity of the portions corresponding to rigid bodies in the portions corresponding to individual rigid bodies 
can be obtained by measurement or the like in advance. 

[0042] Thus, the positions of center of gravity and accelerations of a bipedal walking body can be easily determined 
30 in real time without the need fo ' attaching a relatively large sensor or the like to the bipedal walking body. 

[0043] Preferably, the reference point is set in the torso when determining the positions of center of gravity and 
accelerations of a bipedal walhing body, as described above. This makes it possible to attach a sensor, such as an 
accelerometer, for measuring c ccelerations of the reference point in the absolute coordinate system to the torso, so 
that the number of sensors attached to leg bodies can be reduced, making it possible to prevent the sensors from 
35 interfering with a walking motio i of the bipedal walking body. 

[0044] I n the case of a human being or the like having a waist connected to the two leg bodies through the intermediary 
of hip joints, and a chest locate i on the waist such that it may be tilted with respect to the waist, tilt angles of the torso 
used to determine the position of center of gravity are preferably tilt angles of the waist and the chest, respectively. 
Especially in this case, the rigic body link model is preferably a model that represents cruses under knee joints of the 
40 leg bodies of the bipedal walkin< j body, thighs between the knee joints and the hip joints, the waist, and a body including 
the chest located on the waist, as respective rigid bodies. 

[0045] With this arrangemen , if a bipedal walking body is a human being, positions of center of gravity and accel- 
erations thereof can be accura ely determined, thus permitting higher accuracy of estimated values of floor reaction 
forces to be achieved. 

45 [0046] A method of estimatin 3 joint moments of a bipedal walking body in accordance with the present invention is 
a method for estimating a mom snt acting on at least one joint of respective leg bodies of the bipedal walking body by 
using estimated values of floo reaction forces regarding the leg bodies sequentially determined by the method of 
estimating floor reactions in accordance with the present invention described above. The method of estimating joint 
moments in accordance with th 5 present invention comprises the steps of sequentially measuring tilt angles of a torso 

50 supported on the two leg bodie 5 through the intermediary of hip joints of the respective leg bodies, bending angles of 
at least hip joints and knee join s of the respective leg bodies, and an acceleration in the absolute coordinate system 
of a predetermined reference p Dint of the bipedal walking body, sequentially determining tilt angles of portions corre- 
sponding to rigid bodies of the i: ipedal walking body that are associated with respective rigid bodies of a rigid body link 
mode! on the basis of the tilt angles of the torso, the bending angles of the hip joints and the knee joints of the leg 

55 bodies, and the rigid body link r lodel representing the bipedal walking body in the form of a link assembly of a plurality 
of rigid bodies, sequentially determining positions of centers of gravity of the portions corresponding to rigid bodies in 
relation to the reference point on the basis of the tilt angles of the portions corresponding to the rigid bodies, pre- 
acquired weights of individual portions of the bipedal walking body, which correspond to individual rigid bodies of the 
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rigid body link model and pre-a:quired positions of the centers of gravity of the portions corresponding to rigid bodies 
in the individual portions corresoonding to rigid bodies, and for sequentially determining accelerations of the centers 
of gravity of the portions corresponding to rigid bodies in relation to the reference point on the basis of time-series data 
of the positions of centers of gr ivity of the portions corresponding to the rigid bodies, sequentially determining accel- 
5 erations of the centers of gravi y of the portions corresponding to the rigid bodies in the absolute coordinate system 
from the accelerations of the centers of gravity of the portions corresponding to the rigid bodies in relation to the 
reference point and the accelere tions of the reference point in the absolute coordinate system, sequentially determining 
angular accelerations of the pot ions corresponding to the rigid bodies on the basis of time-series data of the tilt angles 
of the portions corresponding to the rigid bodies, and sequentially determining estimated positions of points of appli- 
10 cation of floor reaction forces o the leg bodies in the bipedal walking body on the basis of at least either tilt angles of 
thighs of the leg bodies as the portions corresponding to the rigid bodies of the bipedal walking body or bending angles 
of knee joints of the leg bodies, wherein a moment acting on at least one joint of the leg bodies of the bipedal walking 
body is estimated on the basis of an inverse dynamic model by using the estimated values of the floor reaction forces, 
estimated positions of points o application of floor reaction forces, the accelerations of the centers of gravity of the 
15 portions corresponding to the rigid bodies and the angular accelerations of the portions corresponding to the rigid 
bodies in the absolute coordina e system, the tilt angles of the portions corresponding to the rigid bodies, pre-acquired 
weights and sizes of the portior s corresponding to the rigid bodies, pre-acquired positions of the centers of gravity of 
the portions corresponding to tne rigid bodies in the respective portions corresponding to the rigid bodies, and pre- 
acquired inertia! moments of th 5 portions corresponding to the rigid bodies. 
20 [0047] If, as described above the second step in the method of estimating floor reactions includes a step for meas- 
uring a tilt angle of a torso, bene ing angles of hip joints and knee joints, respectively, of leg bodies, and an acceleration 
of a reference point of the bipedal walking body in the absolute coordinate system so as to determine a position of 
center of gravity, etc., of the bipedal walking body in relation to the reference point, then there is no need to measure 
them anew. As the rigid link mo Jel. the same rigid link model as that used for determining the position of the center of 
gravity, etc., of the bipedal walHng body may be used. 
[0048] According to the meth< >d of estimating joint moments in accordance with the present invention, measurement 
data obtained by measuring tilt angles of a torso and bending angles of hip joints and knee joints makes it possible to 
determine tilt angles of the port ons corresponding to the rigid bodies of the bipedal walking body, including the torso, 
thighs and cruses (representing a mutual posture relationship among the portions corresponding to the rigid bodies). 
30 Positions of the centers of gra\ ity of the portions corresponding to the rigid bodies in relation to the reference point 
can be determined on the basi;; of the weights of the portions corresponding to the rigid bodies, the positions of the 
centers of gravity of the portion; ; corresponding to the rigid bodies in the respective portions corresponding to the rigid 
bodies (more specifically, positi 3ns of the portions corresponding to the rigid bodies in a coordinate system fixed with 
respect to the portions corresc Dnding to the rigid bodies), and tilt angles of the portions corresponding to the rigid 
35 bodies. Furthermore, the accelerations of the center of gravity of the respective portions corresponding to the rigid 
bodies with respect to the refer- mce point can be determined as two-level differentia! values of the positions of center 
of gravity obtained from the time -series data of the positions of center of gravity. Hence, by measuring the accelerations 
of the reference point in the abi olute coordinate system beforehand, the accelerations of the centers of gravity of the 
portions corresponding to the ric id bodies of the bipedal walking body in the absolute coordinate system are determined 
^o in terms of resultant accelerations of the accelerations of the centers of gravity with respect to the reference point and 
the accelerations of the reference point (acceleration in the absolute coordinate system). 

[0049] Furthermore, angular iccelerations of the portions corresponding to the rigid bodies are determined as two- 
level differential values of tilt ar gles obtained from time-series data of tilt angles of the portions corresponding to the 
rigid bodies. 

^5 [0050] According to the know edge of the inventors of the present application, positions of application points of floor 
reaction forces of leg bodies in a bipedal walking body, e.g., positions of application points of floor reaction forces of 
the leg bodies with respect to a nkles of the leg bodies, are closely correlated to tilt angles of thighs of the (eg bodies 
as the portions corresponding t > the rigid bodies of the bipedal walking body and bending angles of knee joints of the 
leg bodies. Therefore, estimate i positions of the application points of floor reaction forces in the bipedal walking body 

50 can be determined on the basis of at least either the tilt angles of the thighs of the leg bodies or the bending angles of 
the knee joints. 

[0051 ] As described above, w nen the accelerations of the centers of gravity of the portions corresponding to the rigid 
bodies of the bipedal walking tody, the angular accelerations of the portions corresponding to the rigid bodies, and 
estimated positions of the appl cation points of the floor reaction forces have been determined, the data, including 
55 these values and estimated vali les of the floor reaction forces determined by the method of estimating floor reactions, 
can be used to estimate momer ts acting on knee joints and hip joints of the leg bodies on the basis of a publicly known 
so-called inverse dynamic mocel. In short, according to a method based on the inverse dynamic model, moments 
acting on the joints of a bipede walking body that correspond to joints of a rigid body link model are determined in 
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order, beginning with one closest to a floor reaction force application point, using an equation of motion related to 
translational motion of the centars of gravity of the portions corresponding to the rigid bodies of the bipedal walking 
body and an equation of motio l related to rotational motions of the portions corresponding to the rigid bodies (e.g., 
rotational motions around the ce nters of gravity of the portions corresponding to the rigid bodies). Although more details 

5 will be discussed later, if, for example, each leg body is regarded as a link assembly having a thigh and a cms as 
portions corresponding to the r gid bodies, then a force (joint reaction force) acting on a knee joint of each leg body 
can be determined by applying i in acceleration of the center of gravity of the cms, an estimated value of a floor reaction 
force acting on the leg body ? an i a value of the weight of the crus to the equation of motion related to the translational 
motion of the center of gravity <>f the crus of each leg body. Furthermore, a moment of the knee joint of the leg body 

10 can be estimated by applying a joint reaction force acting on the knee joint of the leg body, an angular acceleration of 
the crus of the leg body, an estimated position of the floor reaction force application point of the leg body, an estimated 
value of the floor reaction force of the leg body, data values related to a position of the center of gravity of the crus in 
the crus and a size (length) of tie crus. a value of an inertia! moment of the crus, and a value of a tilt angle of the crus 
to the equation of motion related to the rotational motion of the crus. 

15 [0052] A joint reaction force acting on a hip joint of the leg body can be determined by applying an acceleration of 
the center of gravity of the thigh a joint reaction force acting on the knee joint of the leg body, and a value of the weight 
of the thigh to the equation of motion regarding the translational motion of the center of gravity of the thigh of each leg 
body. Furthermore, a moment of a hip joint of the teg body can be estimated by applying joint reaction forces acting 
on the knee joint and the hip joint, respectively, of the leg body, an angular acceleration of the thigh of the leg body, 

20 data values related to a position of the center of gravity of the thigh in the thigh and a size (length) of the thigh, a value 
of an inertial moment of the thigh, and a value of a tilt angle of the thigh to an equation of motion related to a rotational 
motion of the thigh. 

[0053] According to the method of estimating joint moments in accordance with the present invention, estimating a 
moment acting on a joint of a leg body, using an estimated value of a floor reaction force determined by the aforemen- 
25 tioned method of estimating floor reactions in accordance with the present invention makes it possible to estimate 
moments acting on joints of a leg body in real time with relatively high accuracy without the need for attaching relatively 
large sensors or the like to a bioedal walking body. 

BRIEF DESCRIPTION OF THf '. DRAWINGS 

30 

[0054] Fig. 1 (a) and Fig. 1 (b) are diagrams for explaining a basic principle of a method of estimating floor reactions 
in accordance with the presen invention, Fig. 2 is a diagram schematically showing a human being regarded as a 
bipedal walking body and a con struction of an apparatus installed on the human being in an embodiment of the present 
invention, Fig. 3 is a block diagram for explaining functions of an arithmetic processing unit installed in the apparatus 

35 shown in Fig. 2, and Fig. 4 is a c iagram showing a rigid body link model used for processing performed by the arithmetic 
processing unit shown in Fig. 3 Fig. 5 is a chart illustrating a correlation between a component in a direction of move- 
ment of a vector of a floor react on force application point and a tilt angle of a thigh during normal walk, Fig. 6 is a chart 
illustrating a correlation betwee n a component in a vertical direction of the vector of the floor reaction force application 
point and the tilt angle of the th gh during normal walk, Fig. 7 is a chart illustrating a correlation between a component 

40 in the direction of movement o the vector of a floor reaction force application point and the bending angle of a knee 
joint when sitting on a chair. Fig 8 is a chart illustrating a correlation between a component in the direction of movement 
of the vector of a floor reaction force application point and the bending angle of the knee joint when standing up from 
a chair, Fig. 9 is a chart illustra ing a correlation between a component in the direction of movement of a vector of the 
floor reaction force application )oint and a tilt angle of a thigh when climbing stairs, and Fig. 1 0 is a chart illustrating a 

45 correlation between the compc nent in the direction of movement of the vector of the floor reaction force application 
point and the tilt angle of a thich when walking down stairs. Fig. 1 1 is a diagram for explaining processing performed 
by the arithmetic processing ur it shown in Fig. 3, Fig. 12 is a chart showing a correlation between a moving speed of 
a human being and a double s ance period. Fig. 13(a) is a chart showing a relationship between double stance time 
and a component in a vertical d rection of a floor reaction force, and Fig. 1 3(b) is a chart showing a relationship between 

50 the double stance time and a component in the direction of movement of the floor reaction force. Fig. 14 is a diagram 
for explaining processing perfc rimed by the arithmetic processing unit shown in Fig. 3, Fig. 15 is a graph illustrating 
time-dependent changes of an estimated value of a floor reaction force determined in the embodiment of the present 
invention, and Fig. 16 is a grap h illustrating time-dependent changes of estimated values of moments of a knee joint 
and a hip joint determined by tne embodiment of the present invention. 

55 

BEST MODE FOR CARRYING; OUT THE INVENTION 

[0055] An embodiment in accordance with the present invention will be explained with reference to the aforesaid 
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Fig. 1 and Fig. 2 to Fig. 12. 

[0056] The present embodiment is an embodiment to which a method of estimating floor reactions and a method of 
estimating joint moments in accordance with the present invention have been applied to a human being regarded as 
a bipedal walking body. 

5 [0057] As schematically show i in Fig. 2, a human being 1 is roughly constructed of a pair of right and left leg bodies 
2, 2. a torso 5 formed of a wais 3 and a chest 4. a head 6, and a pair of right and left arms 7. 7. In the torso 5, the 
waist 3 is connected to the leg bodies 2. 2 through the intermediary of a pair of right and left hip joints 8, 8 ; and supported 
on the two leg bodies 2, 2. The c nest 4 of the torso 5 is tiltably located on the upper side of the waist 3 toward the front 
side of the human being 1 in rele tion to the waist 3. Arms 7, 7 are provided such that they extend from both upper right 

io and left sides of the chest 4. and the head 6 is supported on an upper end portion of the chest 4. 

[0058] Each of the leg bodies 2, 2 has a thigh 9 extending from the hip joint 8 ; and a crus 11 extending from a distal 
end of the thigh 9 via a knee joint 10. A foot portion 13 is connected to a distal end of the crus 11 via an ankle (ankle 
joint) 12. 

[0059] According to the present embodiment, an apparatus described below is installed on the human being 1 to 
15 estimate floor reaction forces acting on the leg bodies 2 of the human being 1 having such a construction and also to 
estimate moments acting on the knee joints 1 0 and the hip joints 8. 

[0060] Installed to the chest 4 of the torso 5 are a gyro sensor 14 generating outputs based on angular velocities 
involved in tilts of the chest 4 (h jreinafter referred to as "the chest gyro sensor 14"), an accelerometer 15 generating 
outputs based on accelerations n a longitudinal direction of the chest 4 (hereinafter referred to as "chest longitudinal 

20 accelerometer 15 M ), an arithmeti ; processing unit 16 constructed of a CPU, RAM, ROM, etc., and a battery 17 providing 
a power source of the arithmetic Drocessing unit 1 6, etc. In this case, these chest gyro sensor 1 4, the chest longitudinal 
accelerometer 15, the arithmetic processing unit 16, and the battery 17 are housed in an accommodating member 18 
shaped like a shoulder bag fixec to, for example, the chest 4 through the intermediary of a belt or the like, which is not 
shown, so as to be integrally fix >d to the chest 4 through the intermediary of the accommodating member 1 8. 

25 [0061] To be more specific, a i acceleration indicated by an output of the chest accelerometer 15 is a longitudinal 
acceleration in the horizontal sectional direction of the chest 4 (direction orthogonal to an axial center of the chest 4). 
When the human being 1 stancs upright on a flat ground, the acceleration is in the longitudinal horizontal direction 
(direction of an X-axis of the abi .olute coordinate system shown in Fig. 2). When the waist 3 or the chest 4 is inclined 
from a vertical direction (directum of a Z-axis of the absolute coordinate system shown in Fig. 2), the acceleration is 

30 in a direction inclined with respe ct to the horizontal direction by a tilt angle with respect to the vertical direction of the 
chest 4. 

[0062] Furthermore, a gyro se nsor 1 9 generating outputs based on angular velocities involved in tilts of the waist 3 
(hereinafter referred to as "the w aist gyro sensor 1 9") , an accelerometer 20 generating outputs based on accelerations 
in a longitudinal direction of the waist 3 (hereinafter referred to as "the waist longitudinal accelerometer 20"), and an 
35 accelerometer 21 generating ou puts based on vertical accelerations of the waist 3 (hereinafter referred to as "the waist 
vertical accelerometer 21 ") are ntegrally installed and fixed to the waist 3 of the torso 5 through the intermediary of a 
fixing means : such as a belt, wr ich is not shown. 

[0063] As in the case of the chest longitudinal accelerometer 15, the waist longitudinal accelerometer 20 is, to be 
more specific, a sensor for detesting longitudinal accelerations in the horizontal sectional direction of the waist 3 (di- 
40 rection orthogonal to an axial C3nter of the waist 3). The waist vertical accelerometer 21 is, to be more specific, a 
sensor for detecting vertical acc< lerations in the axial direction of the waist 3 (the vertical accelerations being orthogonal 
to the accelerations detected by the waist longitudinal accelerometer 20). The waist longitudinal accelerometer 20 and 
the waist vertical accelerometei 21 may be integrated in the form of a biaxial accelerometer. 

[0064] The hip joint 8 and the knee joint 1 0 of each of the leg bodies 2 are provided with a hip joint angle sensor 22 
45 and a knee joint angle sensor >3 that generate outputs based on their bending angles ABc and Afid, respectively. 
Regarding the hip joint angle sc nsors 22, only the hip joint angle sensor 22 associated with the hip joint 8 of the leg 
body 2 on this side (right side, a s observed in the forward direction of the human being 1) is shown in Fig. 2. However, 
another hip joint angle sensor 2 2 is attached to the hip joint 8 of the leg body 2 on the other side (left side in relation 
to the forward direction of the h jman being 1 ) concentrically to the hip joint angle senor 22 on this side. 
50 [0065] These angle sensors 12 and 23 are formed of, for example, potentiometers, and attached to the respective 
leg bodies 2 through the intermediary of means, such as band members or the like, which are not shown. Here, the 
bending angles A0c detected b) the hip joint angle sensors 22 are, to be more specific, rotational angles of the thigh 
9 of each leg body 2 around the lip joint 8 (around the axial center of the hip joint 8 in the lateral direction of the human 
being 1 ) with respect to the wais 3 on the basis of a reference defined by a predetermined posture relationship between 
55 the waist 3 and the thigh 9 of euch leg body 2 (e.g., a posture relationship in which an axial center of the waist 3 and 
an axial center of the thigh 9 are substantially parallel, as in a posture of the human being 1 standing upright). Similarly, 
the bending angles A6d detected by the knee joint angle sensors 23 are rotational angles of the crus 11 around the 
knee joint 10 with respect to the thigh 9 (around the axial center of the knee joint 10 in the lateral direction of the human 
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being 1 ) on the basis of a reference defined by a predetermined posture relationship between the thigh 9 and the crus 
11 of each leg body 2 (e.g., a posture relationship in which an axial center of the thigh 9 and an axial center of the crus 
11 are substantially parallel). 

[0066] The foregoing sensors 14, 15, and 1 9 to 23 are connected to the arithmetic processing unit 16 via signal fines, 

5 which are not shown : so as to supply their outputs to the arithmetic processing unit 1 6. 

[0067] The arithmetic processing unit 16 is provided with functional means, as shown in Fig. 3. Specifically, the 
arithmetic processing unit 1 6 is equipped with a leg body motion determining means 24 that uses data detected by the 
waist vertical accelerometer 21 and data obtained by a clocking means 35 and a double stance period estimating 
means 37. respectively, which v\ ill be discussed hereinafter, so as to determine whether motion states of the leg bodies 

10 2. 2 of the human being 1 are in the single stance state (the state shown in Fig. 1 (a)) or the double stance state (the 
state shown in Fig. 1 (b)). The ai ithmetic processing unit 1 6 is further provided with a chest tilt angle measuring means 
25 that uses detection data of the chest longitudinal accelerometer 15 and the chest gyro sensor 14 so as to measure 
a tilt angle Ga in an absolute coordinate system Cf of the chest 4 (as a specific example, a tilt angle Ga with respect to 
a vertical direction; refer to Fig 2) and a waist tilt angle measuring means 26 that uses detection data of the waist 

15 longitudinal accelerometer 20 a id the waist gyro sensor 1 9 so as to measure a tilt angle 6b in an absolute coordinate 
system Cf of the waist 3 (as a specific example, a tilt angle 0b with respect to a vertical direction; refer to Fig. 2). 
[0068] The arithmetic processing unit 1 6 is further provided with a reference acceleration measuring means 27 that 
uses detection data of the waisi longitudinal accelerometer 20 and the waist vertical accelerometer 21 and data of the 
tilt angle Gb of the waist 3 measured by the waist tilt angle measuring means 26 so as to determine an acceleration 

20 (translationai acceleration) a 0 = " (a 0x , a 0z ) in the absolute coordinate system Cf at an origin O of a bodily coordinate 
system Cp (xz-coordinate in Fi< j. 2) set at the waist 3 ; as shown in Fig. 2, as a reference point of the human being 1 
in the present embodiment. Here, the bodily coordinate system Cp is, to be more specific, a coordinate system, for 
example, that has a midpoint < f a line connecting centers of the right and left hip joints 8, 8 of the human being 1 
defined as the origin O, a verti ;al direction being defined as a z-axis direction, and a forward horizontal direction of 

25 the human being 1 defined as an x-axis direction (a coordinate system in which the directions of the three axes are 
the same as those in the aforei aid absolute coordinate system Cf). 

[0069] The arithmetic proces >ing unit 1 6 is further provided with a leg body posture calculating means 28 -that uses 
detection data of the hip joint a lgle sensor 22 and the knee joint angle sensor 23 of each leg body 2 and data of the 
tilt angle 6b of the waist 3 by tr e waist tilt angle measuring means 26 so as to determine tilt angles Be and Gd of the 
30 thigh 9 and the crus 11 , respectively, of each leg body 2 in an absolute coordinate system Cf (as specific examples, 
tilt angles Gc and Gd with respe :t to a vertical direction; refer to Fig. 2). 

[0070] The arithmetic proces sing unit 1 6 is further provided with a means 29 that calculates a position of center of 
gravity of each portion that use s data of a tilt angle Ga of the chest 4, a tilt angle 6b of the waist 3, and a tilt angle Gc 
of the thigh 9 and a tilt angle Gc of the crus 1 1 of each leg body 2, which are obtained by the chest tilt angle measuring 

35 means 25, the waist tilt angle measuring means 26, and the leg body posture calculating means 28, to determine 
positions of the centers of grav ty of portions corresponding to the rigid bodies of the human being 1 associated with 
a rigid body link model to be di icussed hereinafter (to be more specific, positions of the centers of gravity of portions 
corresponding to the rigid bodies in the bodily coordinate system Cp), a bodily center of gravity position calculating 
means 30 that uses data of posi ions of centers of gravity of portions corresponding to the rigid bodies so as to determine 

40 a position of center of gravity o body GO of the entire human being 1 in the bodily coordinate system Cp (hereinafter 
referred to as "the center of gravity of body GO"; refer to Fig. 1). and a bodily center of gravity acceleration calculating 
means 31 that uses data of the position of the center of gravity of body GO and data of the acceleration a 0 at the origin 
O of the bodily coordinate systc m Cp by the reference acceleration measuring means 27 so as to determine an accel- 
eration a= T (ax, az)(refer to Fig 1) of the center of gravity of body GO in the absolute coordinate system Cf. 

45 [0071 ] The arithmetic proces sing unit 16 is further provided with a means 32 that calculates an acceleration of each 
portion of a leg body that uses data of positions of centers of gravity of portions corresponding to the rigid bodies of 
the human being 1 (to be mom specific, positions of centers of gravity of portions corresponding to the rigid bodies 
related to the leg bodies 2) by he means 29 that calculates a position of center of gravity of each portion and data of 
the acceleration a 0 at the origir O of the bodily coordinate system Cp by the reference acceleration measuring means 

50 27 so as to determine accelera lions (translationai accelerations) of centers of gravity of the thigh 9 and the crus 1 1 of 
each leg body 2 in the absolute coordinate system Cf, a means 33 that calculates an angular acceleration of each 
portion of a leg body that use? data of the tilt angles Gc and Gd of the thigh 9 and the crus 11 of each leg body 2, 
respectively, by the leg body pc sture calculating means 28 so as to determine angular accelerations of the thigh 9 and 
the crus 11 of each leg body 2 in the absolute coordinate system Cf, and a floor reaction force application point esti- 

55 mating means 34 that uses dat i of the tilt angle Gc of the thigh 9 of each leg body 2 by the leg body posture calculating 
means 28 and a bending angle AGd of the knee joint 1 0 measured by the knee joint angle sensor 23 so as to estimate 
a position of a point of application of a floor reaction force of each leg body 2 in contact with the ground. 
[0072] The arithmetic processing unit 1 6 is further provided with a clocking means 35 that clocks time elapsed from 
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a start of a double stance state *ach time the start of the double stance state (an end of a single stance state) is found 
by the leg body motion determi Ting means 24, a moving speed estimating means 36 that uses data of the tilt angles 
Gc and Hd of the thigh 9 and tho crus 11 of each leg body 2, respectively, by the leg body posture calculating means 
28 and clocking data of the do iking means 35 so as to estimate a moving speed of the human being 1 each time a 
5 start of the double stance state ;an end of the single stance state) is found by the leg body motion determining means 
24 ; and a double stance perioc estimating means 37 for estimating time from a start to an end of the double stance 
state (duration of the double stance slate: hereinafter referred to as "the double stance period") from data of moving 
speed determined by the movirg speed estimating means 36. 

[0073] The arithmetic processing unit 16 is further equipped with a floor reaction force estimating means 38 that 
10 determines an estimated value of a floor reaction force acting on each leg body 2 by using data of the acceleration a 
of a bodily center of gravity SLoplied by the bodily center of gravity acceleration calculating means 31, data of an 
estimated value of a double ste nee period supplied by the double stance period estimating means 37. clocking data 
supplied by the clocking means 37, and data of a determination result of a motion state of the leg body 2 supplied by 
the leg body motion determining means 24, and a joint moment estimating means 39 for estimating moments acting 
15 on the knee joint 1 0 and the hip joint 8 of each leg body 2 by using this data of the estimated value of the floor reaction 
force, data of accelerations of c inters of gravity of the thigh 9 and the crus 1 1 of each leg body 2 supplied by the means 
32 that calculates an acceleraton of each portion of a leg body, data of angular accelerations of the thigh 9 and the 
crus 11 of each leg body 2 supolied by the means 33 that calculates an angular acceleration of each portion of a leg 
body, data of an estimated position of a point of application of a floor reaction force supplied by the floor reaction force 
20 application point estimating me ins 34, and data of the tilt angles 0c and Gd of the thigh 9 and the crus 11 , respectively, 
of each leg body 2 supplied by the leg body posture calculating means 28. 

[0074] An operation of the present embodiment will be explained in combination with more detailed description of 
processing by each means of t ie aforementioned arithmetic processing unit 16. 

[0075] In the present embodi nent, when, for example, the human being 1 moves by walking, if a power switch, not 
25 shown, of the arithmetic proces sing unit 1 6 is turned on while both leg bodies 2 and 2 are in contact with a floor, then 
processing is sequentially carri. >d out by the arithmetic processing unit 1 6 at a predetermined cycle time, as explained 
below, so as to sequentially de ermine estimated values, etc. acting on each leg body 2. 

[0076] First, the arithmetic piocessing unit 16 implements processing by the chest tilt angle measuring means 25 
and the waist tilt angle measun ig means 26. In this case, the processing by the chest tilt angle measuring means 25 

30 sequentially determines the tilt e ngle 6a of the chest 4 in the absolute coordinate system Cf at each cycle time mentioned 
above by a publicly known tech lique based on the so-called Kalman filter processing, using longitudinal accelerations 
of the chest 4 received from the chest longitudinal accelerometer 1 5 and the chest gyro sensor 14, and detection data 
of an angular velocity of the chi >st 4. Similarly, the processing by the waist tilt angle measuring means 25 sequentially 
determines the tilt angle eb of t ie waist 3 in the absolute coordinate system Cf by the Kalman filter processing, using 

35 longitudinal accelerations of the waist 3 received from the waist longitudinal accelerometer 20 and the waist gyro sensor 
19, and detection data of an an ^ular velocity of the waist 3. Here, the tilt angles ea and 0b of the chest 4 and the waist 
3, respectively, in the absolute « coordinate system Cf denote tilt angles with respect to, for example, a vertical direction 
(gravitational direction) in the p-esent embodiment. 

[0077] The tilt angles of the Dhest 4 and the waist 3 can be alternatively determined by, for example, integrating 
to detection data of angular velocities obtained by the gyro sensors 14 and 19. However, performing the Kalman filter 
processing, as in the present er ibodiment, allows the tilt angles 9a and 0b of the chest 4 and the waist 3 to be measured 
with high accuracy. 

[0078] Next, the arithmetic p ocessing unit 16 performs processing by the leg body posture calculating means 28 
and processing by the reference acceleration measuring means 27. 

45 [0079] In the processing imp emented by the leg body posture calculating means 28, the tilt angles Gc and fid (tilt 
angles with respect to the vertcal direction; refer to Fig. 2) of the thigh 9 and the crus 11 of each leg body 2 in the 
absolute coordinate system Cf are determined at each cycle time, as described below. The tilt angle 6c of the thigh 9 
of each leg body 2 is calculate i according to expression (4) given below on the basis of a current value of detection 
data of the bending angle ABc :>f the hip joint 8 supplied by the hip joint angle sensor 22 attached to the leg body 2 

so and a current value of the tilt angle Gb of the waist 3 determined by the waist tilt angle measuring means 25: 



Gc = Gb + AGc (4) 

where the tilt angle Gb of 1 ne waist 3 takes a negative value if the waist 3 tilts with respect to the vertical direction 
such that an upper end portion of the waist 3 juts out farther to the front side of the human being 1 than a lower end 
portion thereof; and the bendin j angle AGc of the hip joint 8 takes a positive value if the thigh 9 tilts with respect to the 
axial center of the waist 3 such 1 hat a lower end portion of the thigh 9 juts out toward the front side of the human being 1 . 
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[0080] Furthermore, the tilt ar gle 6d of the crus 11 of each leg body 2 is calculated according to expression (5) given 
below on the basis of a current value of the tilt angle 0c of the thigh 9 determined as described above and a current 
value of detection data of the bending angle ABd of the knee joint 1 0 supplied by the knee joint angle sensor23 attached 
to the leg body 2: 

Bd-ec^ABd (5) 



where the bending angle )f the knee joint 1 0 takes a positive value if the crus 1 1 tilts toward the rear side of the 

10 thigh 9 with respect to the axial center of the thigh 9. 

[0081] In the processing by the reference acceleration measuring means 27, the acceleration a 0 = T (a 0 x, a 0 z) in the 
absolute coordinate system Cf )f the origin O of the bodily coordinate system Cp is determined as described below. If 
a current value of detection dat a of a longitudinal acceleration of the waist 3 supplied by the waist longitudinal accel- 
erometer 20 is denoted as ap, md a current value of detection data of a vertical acceleration of the waist 3 supplied 

15 by the waist vertical accelerometer21 is denoted as aq, then the acceleration a 0 = T (a 0 x, a 0 z) in the absolute coordinate 
system Cf is determined accord ng to expression (6) given below from the detection data ap and aq and a current value 
of the tilt angle Gb of the waist M obtained by the waist tilt angle measuring means 25: 

20 a 0~ ( a 0 X; a 0 Z ) 

= T (ap • cosOb - aq • sinOb, ap • sinGb + aq • cosOb) (6) 



[0082] The arithmetic processing unit 16 then carries out processing by the means 29 that calculates a position of 
center of gravity of each portion to determine a position of center of gravity of each portion corresponding to a rigid 
body of the human being 1 in he bodily coordinate system Cp (a position with respect to the origin O of the bodily 
coordinate system Cp), using e rigid body link model explained below. 

[0083] As shown in Fig. 4 : a rigid body link model R used in the present embodiment is a model representing the 
human being 1 by connecting ri }id bodies R1 and R1 corresponding to the thighs 9 of the respective leg bodies 2, rigid 
bodies R2 and R2 correspondir g to the cruses 1 1 , the rigid body R3 corresponding to the waist 3, and a rigid body R4 
corresponding to a portion 40 ( ombining the chest 4, the arms 7 and 7, and the head 6 (hereinafter referred to as a 
"body 40"). In this case, a conn action of the rigid bodies R1 and the rigid body R3 and a connection of the rigid bodies 
R1 and the rigid bodies R2 correspond to the hip joint 8 and a knee joint 10, respectively. A connection of the rigid 
body R3 and the rigid body R4 provides a tilt supporting point 41 of the chest 4 with respect to the waist 3. 
[0084] In the present embod nent, positions of centers of gravity G1 , G2, G3 and G4 of portions corresponding to 
the rigid bodies (the thighs 9 aid the cruses 11 of the respective leg bodies 2, the waist 3, and the body 40) of the 
human being 1 associated wit i the rigid bodies R1 to R4 of the rigid body link model R in the respective portions 
corresponding to the rigid bod 3s are determined in advance and stored in a memory, not shown, of the arithmetic 
processing unit 1 6. 

[0085] The positions of the c enters of gravity G1 , G2, G3 and G4 of the portions corresponding to the rigid bodies 
that have been stored and reta ned in the arithmetic processing unit 16 are positions in a coordinate system that are 
fixed for the portions correspon i\ng to the rigid bodies. In this case, as examples of data indicating the positions of the 
centers of gravity G1 , G2, G3 aid G4 of the portions corresponding to the rigid bodies, distances in axial directions of 
the respective portions corresp ending to the rigid bodies from midpoints of joints at one end of each of the respective 
portions corresponding to the ri :jid bodies are used. More specifically, for example, the position of the center of gravity 
G1 of each thigh 9 is indicated as a position at a distance d1 in the axial direction of the thigh 9 from a center of the 
hip joint 8 of the thigh 9, the portion of the center of gravity G2 of each crus 11 is indicated as a position at a distance 
d2 in the axial direction of the cus 11 from a center of the knee joint 1 0 of the crus 11 , as shown in Fig. 4. The values 
of the distances d1 and d2 are determined in advance and stored and retained in the arithmetic processing unit 16. 
The same applies to the positior s of the centers of gravity G3 and G4 of other portions corresponding to the rigid bodies. 
[0086] To be more precise, tt" e position of the center of gravity G4 of the body 40 is subject to influences of motions 
of the arms 7 and 7 included in Xie body 40. In a walking mode, the arms 7 and 7 are in general positionally symmetrical 
with respect to an axial center of the chest 4, so that the position of the center of gravity G4 of the body 40 hardly 
changes, and is substantially tie same as the position of the center of gravity G4 of the body 40 in, for example, an 
upright posture, 

[0087] According to the present embodiment, in addition to the data indicating the positions of the centers of gravity 
G1 , G2, G3 and G4 of the portions corresponding to the rigid bodies (the thighs 9 and the cruses 1 1 of the leg bodies 
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2. the waist 3, and the body 40) data of weights of the portions corresponding to the rigid bodies and data of sizes of 
the portions corresponding to t\ e rigid bodies (e.g.. data of lengths of the portions corresponding to the rigid bodies) 
are determined in advance and stored and retained in the arithmetic processing unit 16. 

[0088] The weight of the crus 11 includes the weight of the foot portion 13. As described above, data to be stored 

5 and retained in the arithmetic processing unit 16 beforehand may be determined by actual measurement or the like, 
or may be estimated on the basis of human average statistic data from height and weight of the human being 1. 
Generally, the positions of thece nters of gravity G1 , G2, G3 and G4, the weights and sizes of the portions corresponding 
to the rigid bodies are correlated with the height and weight of the human being. Based on the correlation data and 
from the height and weight of th 2 human being, the positions of the centers of gravity G1 , G2, G3 and G4, the weights 

io and sizes of the portions corresoonding to the rigid bodies can be estimated with relatively high accuracy. 

[0089] The means 29 that cal :;ulates a position of center of gravity of each portion uses the data stored and retained 
beforehand in the arithmetic processing unit 1 6, as described above, current values of the tilt angle Ba of the chest 4 
(= tilt angle of the body 40) and the tilt angle 6b of the waist-3 determined by the chest tilt angle measuring means 25 
and the waist tilt angle measuring means 26, respectively, and current values of the tilt angles 9c and Bd of the thigh 

15 9 and the crus 11 of each leg body 2, respectively, determined by the leg body posture calculating means 28 so as to 
determine the positions of the c enters of gravity G1 , G2, G3 and G4 of the portions corresponding to the rigid bodies 
in the bodily coordinate system Cp (the xz coordinate shown in Fig. 4) having the origin O fixed at the waist 3. 
[0090] In this case, since the tilt angles Ba to Bd of the portions corresponding to the rigid bodies (the thighs 9 and 
the cruses 1 1 of the leg bodies I, the waist 3 ; and the body 40) have been determined, as described above, positions 

20 and postures of the portions cc responding to the rigid bodies in the bodily coordinate system Cp are obtained from 
data of the foregoing tilt angles Ba to Bd and data of the sizes of the portions corresponding to the rigid bodies. Thus, 
the positions of the centers of g avity G1 , G2, G3 and G4 of the portions corresponding to the rigid bodies in the bodily 
coordinate system Cp can be catermined. 

[0091] To be more specific, r herring to, for example, Fig. 4, regarding the leg body 2 positioned on the left side in 
25 Fig. 4 (the leg body 2 located e t the rear in relation to the direction of travel of the human being 1 ), a tilt angle of the 

thigh 9 in the bodily coordinate system Cp (a tilt angle with respect to the z-axis direction) is 6c (in this case, Be < 0 in 

Fig. 4). Hence, the coordinate c f the position of the center of gravity G1 of the thigh 9 in the bodily coordinate system 

Cp is (d1 • sinBc. -d1 • cosBc). The tilt angie in the bodily coordinate system Cp of the crus 11 is Bd (Bd<0 in Fig. 4); 

therefore, if the length of the thigh 9 is denoted by Dc, then the coordinate of the position of the center of gravity G2 
30 of the crus 11 in the bodily coo dinate system Cp will be (Dc • sinBc+d2 - sinBd, -Dc • cosBc-d2 ■ cosBd). The centers 

of gravity of the thigh 9 and the crus 1 1 of the other leg body 2, and of the waist 3 and the body 38 are determined in 

the same manner as describee above. 

[0092] After determining the positions of the centers of gravity G1 . G2, G3 and G4 of the portions corresponding to 
the rigid bodies in the bodily c< ordinate system Cp by the means 29 that calculates a position of center of gravity of 

35 each portion, the arithmetic pre cessing unit 1 6 executes the processing by the bodily center of gravity position calcu- 
lating means 30 to determine a position (xg, zg) of the center of gravity of body GO of the human being 1 in the bodily 
coordinate system Cp, using d ita of the positions of the centers of gravity G1 , G2, G3 and G4 of the portions corre- 
sponding to the rigid bodies an i data of the weights of the portions corresponding to the rigid bodies. 
[0093] If the position of the c< >nter of gravity G3 and the weight of the waist 3 in the bodily coordinate system Cp are 

40 denoted by (x3, z3) and m3, n spectively, the position of the center of gravity G4 and the weight of the body 40 are 
denoted by (x4, z4) and m4, respectively, the position of the center of gravity G1 and the weight of the thigh 9 of the 
leg body 2, which is located at i 3ft in relation to the traveling direction, of the human being 1 are denoted by (x1 L, z1 L) 
and ml L, respectively, the po< ition of the center of gravity G2 and the weight of the crus 11 of the leg body 2 are 
denoted by (x2L ; z2L) and m2l., respectively, the position of the center of gravity G1 and the weight of the thigh 9 of 

45 the leg body 2 at right are den< >ted by (x1 FT z1 R) and ml R, respectively, the position of the center of gravity G2 and 
the weight of the crus 1 1 of th«s leg body 2 are denoted by (x2R, z2R) and m2R, respectively, and the weight of the 
human being 1 is denoted by M (=m1 L+m2L+m1 R+m2R+m3+m4), then the position (xg, zg) of the center of gravity 
of body of the human being 1 i l the bodily coordinate system Cp is determined by expression (7) given below: 

50 
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[0094] After carrying out the processing by the bodily center of gravity position calculating means 30 ; the arithmetic 
15 processing unit 1 6 further carries out the processing by the bodily center of gravity acceleration calculating means 31 . 
In the processing by the bodily center of gravity acceleration calculating means 31 , first, a two-level differential value 
of a position (xg, zg) of the center of gravity of body GO with respect to the origin O of the bodily coordinate system 
Cp, that is, an acceleration T (d 2 <g/dt 2 . d 2 zg/dt 2 ) of the center of gravity of body GO in the bodily coordinate system Cp 
is determined, using time-series data of the position (xg, zg) of the center of gravity of body GO in the bodily coordinate 
20 system Cp obtained by the bodi y center of gravity position calculating means 30 for each cycle time mentioned above. 
Then, a vector sum of the acce eration T (d 2 xg/dt 2 , d 2 zg/dt 2 ) and the acceleration a 0 = T (a 0 x, agz) in the absolute coor- 
dinate system Cf of the origin O >f the bodily coordinate system Cp determined by the reference acceleration measuring 
means 27 so as to determine ai acceleration a= T (ax, az) of the center of gravity of body GO in the absolute coordinate 
system Cf. 

25 [0095] After carrying out the | processing by the leg body posture calculating means 28 and the means 29 that calcu- 
lates a position of center of gra' ity of each portion, the arithmetic processing unit 1 6 further carries out the processing 
by the means 32 that calculates an acceleration of each portion of a leg body, the means 33 that calculates an angular 
acceleration of each portion of a leg body, and the floor reaction force application point estimating means 34. 
[0096] In this case, as in the p ocessing by the bodily center of gravity acceleration calculating means 31 , the process- 
30 jng by the means 32 that calci lates an acceleration of each portion of a leg body first uses time-series data of the 
positions of the centers of gra\ ity G1 and G2 of the thigh 9 and the crus 11, respectively, which are portions corre- 
sponding to the rigid bodies of *ach leg body 2 in the bodily coordinate system Cp determined by the means 29 that 
calculates a position of center Df gravity of each portion for each cycle time mentioned above thereby to determine 
two-level differential values of t \e positions of the centers of gravity G1 and G2 of the thigh 9 and the crus 11 , respec- 
ts lively, in the bodily coordinate s /stem Cp, that is, accelerations of the centers of gravity G1 and G2 of the thigh 9 and 
the crus 11 , respectively, in the bodily coordinate system Cp (translational accelerations with respect to the origin O 
of the bodily coordinate system Cp). Then, a vector sum of the respective accelerations and the acceleration a 0 = T (aoX, 
a 0 z) in the absolute coordinate s-ystem Cf of the origin O of the bodily coordinate system Cp determined by the reference 
acceleration measuring means 27 so as to determine accelerations of the thigh 9 and the crus 11 , respectively, in the 
40 absolute coordinate system Cf [more specifically, coordinate components of the accelerations in the absolute coordi- 
nate system Cf). 

[0097] Furthermore, in the pr ocessing by the means 33 that calculates an angular acceleration of each portion of a 
leg body, time-series data of th* tilt angles 6c and Gd of the thigh 9 and the crus 11, respectively, of each leg body 2 
obtained by the leg body postu'e calculating means 28 for each cycle time is used to determine two-level differential 
45 values of the tilt angles Ac and i id of the thigh 9 and the crus 1 1 , respectively, that is, angular accelerations of the thigh 
9 and the crus 11 , respectively. 

[0098] In the processing by ti le floor reaction force application point estimating means 34, regarding the leg body 2 
in contact with the ground, a vector (a positional vector of a point of a floor reaction force applied to the ankle 12; the 
vector will be hereinafter refer ed to as the "floor reaction force application point vector") to an floor reaction force 

50 application point of the foot po tion 13 of the leg body 2 from the ancle 12 of the leg body 2 (a point where it can be 
regarded that all floor reaction orces acting on a location where the foot portion 13 is in contact with the ground are 
concentrated) is determined a* data indicating the position of the application point of the floor reaction force on the 
basis of the pre-established co relations shown in Fig. 5 and Fig. 6 from, for example, a current value of the tilt angle 
0c of the thigh 9 calculated by - he leg body posture calculating means 28. 

55 [0099] More specifically, acc >rding to knowledge of the inventors of the present application, a tilt angle 9c of the 
thigh 9 of the leg body 2 in cor tact with the ground and the bending angle A9d of the knee joint 1 0 have a relatively 
marked correlation with a floor 'eaction force application point. For instance, the floor reaction force application point 
vector, more specifically, a component of the floor reaction force application point vector in the direction of travel (the 
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x-axis direction) of the human b>ing 1 and a component of the floor reaction force application point vector in the vertical 
direction (the z-axis direction) -ary with respect to the tilt angle Be of the thigh 9. as illustrated in Fig. 5 and Fig. 6. 
Here, a negative tilt angle 6c o1 the thigh 9 is an angle obtained when the thigh 9 tilts with respect to the axial center 
of the waist 3 such that the lec body 2 extends to the rear side of the human being 1 (e.g., the right leg body 2, as 
5 obsen/ed in the forward directk n of the human being 1 shown in Fig. 2). A positive tilt angle 6c is an angle obtained 
when the Ihigh 9 Lilts with respe ct to the axial cenler of the waisl 3 such that the leg body 2 is on the front side of the 
human being 1 (e.g.. the left \e\\ body 2 in relation to the direction of travel of the human being 1 shown in Fig. 2). 
[0100] According to the prese nt embodiment, an approximate expression that represents the correlations shown in 
Fig. 5 and Fig. 6 and uses the t It angle 6c of the thigh 9 as a parameter is prepared, and the approximate expression 
10 is stored and retained in the at thmetic processing unit 16 beforehand. In the processing by the floor reaction force 
application point estimating means 34, a current value of the tilt angle Be of the thigh 9 obtained by the leg body posture 
calculating means 28 is substituted into the approximate expression thereby to determine the floor reaction force ap- 
plication point vector (to be mo e specific, the components in the x-axis direction and the z-axis direction of the floor 
reaction force application point vector). 
15 [0101] As shown in Fig. 5 anc Fig. 6. in the correlation wherein the tilt angle Gc of the thigh 9 has an extremely small 
value, the value of the floor reaction force application point vector differs between a reducing process and an increasing 
process of the tilt angle Ac even when the tilt angle Be of the thigh 9 remains the same. For this reason, according to 
the present embodiment, to prepare the aforementioned approximate expression, a transition of the correlation from 
the moment the heel of the too: portion 13 touches a floor to the moment a toe leaves the floor is divided into a first 
20 phase in which the tilt angle ec of the thigh 9 is positive (a phase indicated by a1 in Fig. 5 or a phase b1 in Fig. 6), a 
second phase in which the tilt angle 6c of the thigh 9 is negative and a changing speed of the tilt angle Gc of the thigh 
9, i.e., the tilt angular velocity o <: the thigh 9, is negative (a phase indicated by a2 in Fig. 5 or a phase indicated by b2 
in Fig. 6), and a third phase in which the tilt angle 6c of the thigh 9 is negative and the tilt angular velocity of the thigh 
9 is positive (a phase indicatec by a3 in Fig. 5 or a phase indicated by b3 in Fig. 6), and the respective phases are 
25 approximated on the component in the x-axis direction and the component in the z-axis direction, respectively, of the 
floor reaction force application | >oint vector, using the same function or different functions. An approximate expression 
for a phase that combines the irst and second phases a1 and a2, respectively, in the correlation shown in Fig. 5 is 
represented by, for example, a sixth-order polynomial functions (x., to x 7 take constant values) given below when the 
component in the x-axis direction of the floor reaction force application point vector is denoted by Px: 



30 



35 



40 



6 5 4 

Px - x 1 • 0c + x 2 • 8c + x 3 • Gc 

3 2 

+ x 4 • Be + x 5 • Be + x 6 • Be + x 7 

[0102] An approximate expression for the third phase a3 in the correlation of Fig. 5 is represented by, for example, 
a fourth-order polynomial funct Dns (x 8 to x 12 take constant values) as shown below: 

Px - x a • Be 4 + x 9 • 9c 3 + x 10 • 6c 2 + x in • Be + x 12 



[0103] An approximate expression for a phase that combines the first and second phases b1 and b2, respectively, 
in the correlation shown in Fig 6 is represented by for example, a sixth-order polynomial functions (z 1 to z 7 take 
constant values) given below v hen the component in the z-axis direction of the floor reaction force application point 
45 vector is denoted by Pz: 

Pz - z 1 . Bc S + z 2 • Be 5 + z 3 . Be 4 

50 + Z 4 • BC 3 + Z 5 • BC 2 + Z 6 • BC + Z 7 

[0104] An approximate expre ssion for the third phase b3 in the correlation of Fig. 6 is represented by, for example, 
a third-order polynomial functio is (z 8 to z u take constant values) as shown below: 

55 3 2 

Pz - z 8 • Be +-z 9 -Gc +z 10 -Gc + z 11 
[01 05] When determining a floor reaction force application point vector, it is identified whether the tilt angle Be of the 
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thigh 9 is positive or negative a id also identified whether the tilt angular velocity of the thigh 9 calculated by one-level 
differentiation of time-series de:a of the tilt angle Be of the thigh 9 is positive or negative. Furthermore, it is decided 
which phase is currently in on t le basis of the positive or negative tilt angle Be and the positive or negative tilt angular 
velocity, which have been ident fied. and a current value of the tilt angle Be of the thigh 9 is substituted into the approx- 
5 imate equation for the identifier phase so as to calculate the floor reaction force application point vector. This makes 
il possible to calculate, distinguishing between a value of the floor reaction force application point vector in the reducing 
process of the tilt angle Be of thi thigh 9 and a value of the floor reaction force application point vector in the increasing 
process. 

[0106] In the present embodiment the correlation between the tilt angle Be of the thigh 9 of the leg body 2 and the 
10 floor reaction force application point vector is approximated using polynomial equations to determine floor reaction 
force application point vectors. Alternatively, however it is possible to store and retain the correlations shown in Fig. 
5 and Fig. 6 beforehand in tern s of data tables so as to determine floor reaction force application point vectors from 
the tilt angle Be of the thigh 9, ising the data tables. 

[0107] The positions of floor eaction force application points are also correlated to the bending angles of the knee 
15 joint 10 of the leg body 2 in contact with the ground, so that a position of a floor reaction force application point may 
alternatively be estimated from the bending angle ABd of the knee joint 1 0 measured by the knee joint angle sensor 
23, in place of the tilt angle Be o' the thigh 9. As another alternative, a position of a floor reaction force application point 
may be estimated by a map or t ie like, using both the tilt angle Be of the thigh 9 and the bending angle ABd of the knee 
joint 10. 

20 [0108] When the human being 1 is sitting onto a chair or is standing up from the chair, correlations shown in Fig. 7 
(when sitting onto a chair) and Fig. 8 (standing up from the chair) hold between the positions of floor reaction force 
application points and the bend ng angles ABd of the knee joint 1 0. When the human being 1 is climbing or going down 
stairs, correlations shown in Fig 9 (when climbing stairs) and Fig. 10 (going down the stairs) hold between the positions 
of floor reaction force application points and the tilt angles Be of the thigh 9. Therefore, when the human being 1 sits 

25 on or stands up from a chair, the position of a floor reaction force application point can be estimated from the bending 
angle ABd of the knee joint 10 on the basis of the correlations illustrated in Fig. 7 and Fig. 8. When the human being 
1 climbs or goes down stairs, th:* position of a floor reaction force application point can be estimated from the, tilt angles 
Be of the thigh 9 on the basis o the correlations illustrated in Fig. 9 and Fig. 10. 

[01 09] Meanwhile, concurrency with the processing by the aforementioned means 25 to 34, the arithmetic processing 
30 unit 1 6 carries out processing b / the leg body motion determining means 24. In the processing by the leg body motion 
determining means 24, for eacr cycle time,' detection data of upward accelerations of the waist 3 by the waist vertical 
accelerometer 21 is compared with a predetermined threshold value that is set in advance. Then, when a detected 
value of the acceleration excee js the threshold value, it is determined that the double stance state shown in Fig. 1 (b) 
begins and the single stance stc te shown in Fig. 1 (a) ends. More specifically, while the human being 1 is walking, when 
35 the single stance state is replaced by the double stance state, the leg body 2 on the free leg side touching a floor 
causes a relatively large acceleration (an acceleration that cannot be generated in a normal single stance state) to be 
generated substantially upwarcs in the waist 3 in the vicinity of the hip joint 8. For this reason, the leg body motion 
determining means 24 compares the detection data of the upward accelerations of the waist 3 supplied by the waist 
vertical accelerometer 21 with :he predetermined threshold value so as to determine the start of the double stance 
40 state and the end of the single >tance state, as described above. 

[01 10] When it is found by th 3 leg body motion determining means 24 that the double stance state has begun, the 
clocking means 35 starts clock ng the time elapsed from the moment the double stance state starts (cycle time at a 
point when the detection data of the acceleration by the waist vertical accelerometer 21 exceeds the aforesaid threshold 
value). 

45 [0111] Moreover, when the beginning of the double stance state is grasped as mentioned above, the processing by 
the leg body motion determining means 24 sequentially monitors for each cycle time mentioned above whether the 
elapsed time measured by the double stance time clocking means 37 from the point when the double stance state 
started has reached an estimated value of a double stance period (duration of the double stance state from the start 
to the end of the double stance state) determined, as will be discussed hereinafter, by the double stance period esti- 

50 mating means 37 at the point wl en the double stance state starts. When the elapsed time reaches the estimated value 
of the double stance period, the leg body motion determining means 24 determines that the double stance state ends 
and the single stance state starts. 

[0112] After the processing by the leg body motion determining means 24 is implemented and the processing by the 
leg body posture calculating means 28 is implemented, the arithmetic processing unit 16 sequentially carries out 
processing by the moving speed estimating means 36 and the double stance period estimating means 37. 
[0113] The processing by the moving speed estimating means 36 is carried out as follows. Referring to Fig. 11 , when 
the human being 1 walks, the l3g body 2 on the front side of the human being 1 (the leg body 2 on the right side in 
relation to the direction of travel of the human being 1 in the figure), which is indicated by solid lines, touches a floor, 
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causing the double stance stat > to start at time t1 . A case is assumed where the next double stance state begins at 
time t2, as shown by the humar being 1 indicated by virtual lines (a case where the leg body 2 existing at the rear side 
of the human being i leaves tha floor at time t1 : then touches the floor at time t2). At this time, a travel distance L of 
the human being 1 from time t1 to time t2 is a travel distance of the center of the hip joint 8 of the waist 3 in the x-axis 

5 direction (the direction of travel >f the human being 1 ) in the absolute coordinate system Cf (this is equal to a movement 
amount in the x-axis direction cf the origin O of the bodily coordinate system Cp in the present embodiment). 
[0114] The travel distance L substantially coincides with a total sum of a distance AL1 in the x-axis direction from 
the center of the hip joint 8 to tie ankle 12 of the leg body 2 on the front side of the human being 1 at time t1 and a 
distance AL2 in the x-axis direction from the center of the hip joint 8 to the ankle 12 of the leg body 2 on the rear side 

io of the human being 1 at time M (the leg body 2 that was on the front side of the human being 1 at time t1 ). 

[0115] Accordingly, the abov ; distances AL1 and AL2 and the elapsed time from time t1 to time t2 (t2-t1), i.e., the 
elapsed time for one step frorr the start of the double stance state to another start of the double stance state, are 
determined. This makes it poss oleto obtain a moving speed V of the human being 1 from time t1 to t2 (average moving 
speed from time t1 to time t2) according to expression (8) given below, using the distances AL1 and AL2 and the 

15 elapsed time for one step (t2-ti ). 

V = D/(t2-t1 ) - (AL1 + AL2) / (t2 - 11 ) (8) 

20 [0116] In the procejssing by tie moving speed estimating means 36 in the present embodiment, each time the leg 
body motion determining mean > 24 finds a start of the double stance state, the distance AL1 related to the leg body 2 
on the front side of the human \ eing 1 and the distance AL2 related to the leg body 2 on the rear side are determined, 
as explained below, and calculated values of the distances AL1 and AL2 are stored and retained. Then, the moving 
speed V of the human being 1 s determined according to the above expression (8), using the distance AL2 related to 

25 the leg body 2 on the rear side determined at the start of the present double stance state, the distance AL1 related to 
the leg body 2 on the front side determined at the start of the previous double stance state, and time (=t2-t1 ) measured 
by the clocking means 37 from the start of the previous double stance state to the start of the present double stance 
state. 

[0117] In this case, the aforesaid distances AL1 and AL2 are determined, as discussed below. Regarding the leg 
30 body 2 on the front side of the \ uman being 1 at a start of the double stance state ; the tilt angles of the thigh 9 and the 
crus 11 to be determined by the leg body posture calculating means 28 at a start of the double stance state (the cycle 
time at which a start of the dout ie stance state is identified by the leg body motion determining means 24) are denoted 
by eel and Bd1 , respectively (r jfer to the graph of time t1 of Fig. 11 ). At this time, the distance AL1 related to the leg 
body 2 is calculated according t > expression (9) given below, using data of these tilt angles 9ct and ed1 (6c1 >0, Gd1 >0) 
35 and data of lengths Dc and Dd of the thigh 9 and the crus 11 . respectively. 

AL1 = Dc • slnGd + Dd • sinGdl (9) 

40 [0118] Similarly, regarding th ? leg body 2 on the rear side of the human being 1 at a start of the double stance state, 
if the tilt angles of the thigh 9 ar d the crus 11 to be determined by the leg body posture calculating means 28 at a start 
of the double stance state are denoted by 0c2 and 6d2, respectively (refer to the graph of time t2 of Fig. 11), then the 
distance AL2 related to the leg body 2 is calculated according to expression (10) given below, using data of these tilt 
angles 8c2 and Bd2 (6c2<0, 9d ?<0) and the data of the lengths Dc and Dd of the thigh 9 and the crus 11 , respectively. 

45 

AL1 = -Dc - sinBc2 - Dd • sin9d2 (10) 



50 



[0119] By the processing by :he moving speed estimating means 36 explained above, the moving speed V of the 
human being 1 (to be more spe ;ific, the moving speed in one step immediately before the double stance state begins) 
is estimated each time the doul >le stance state begins. In each cycle time during the period from a start of the double 
stance state to the next start of the double stance state, an estimated value of the moving speed V is maintained at a 
constant value. 

[0120] The processing by th > double stance period estimating means 37 is carried out as follows. According to 
55 knowledge of the inventors of Ine present application, the double stance period, which is the duration of the double 
stance state while the human bsing 1 is walking, has a close correlation with the moving speed V of the human being 
1. More specifically, the double stance period while the human being 1 is walking changes in relation to the moving 
speed V, as shown in Fig. 12. The double stance period shortens as the moving speed V increases. 
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[0121] In the present embodiment the correlation shown in Fig. 12 is stored and retained beforehand in the arithmetic 
processing unit 16 in the form cf a data table or polynomial functions approximating it. In the processing by the double 
stance period estimating mears 37. at a start of the double stance state, an estimated value of the double stance 
period related to the double stance state is determined on the basis of the correlation shown in Fig. 12 from a most 

5 recent value of the moving speed V determined by the moving speed estimating means 36 as described above. The 
estimated value of the double j lance period is maintained until the next double stance state begins. 
[0122] The arithmetic processing unit 1 6 carries out the processing by the bodily center or gravity acceleration cal- 
culating means 31 . tne leg bod/ motion determining means 24, the clocking means 35, and the double stance period 
estimating means 37. and thereafter carries out the processing by the floor reaction force estimating means 38 for 

10 each cycle time. In the processing by the floor reaction force estimating means 38, data of the acceleration T (ax, az) 
of the center of gravity of body GO determined by the bodily center of gravity acceleration calculating means 31 and 
the data of a weight M of the human being 1 are used to sequentially determine an estimated value of a total floor 
reaction force F - T (Fx, Fz) according to the above expression (2) for each cycle time. In this case, if the motion state 
of the leg body 2 identified by tie leg body motion determining means 24 is the single stance state, then an estimated 

15 value of the above total floor reaction force F - T (Fx, Fz) will be directly determined as an estimated value of the fioor 
reaction force acting on the single leg body 2 in contact with the ground. 

[0123] Meanwhile, if a motion state of the leg body 2 determined by the leg body determining means 24 is the double 
stance state, then the floor reaction force estimating means 38 determines the floor reaction forces Fr= T (Frx, Frz) and 
Ff= T (Ffx. Ffz) acting on the respective leg bodies 2 as follows. According to the knowledge of the inventors of the 

20 present application, if attention is focused on a relationship between a ratio of each component of the floor reaction 
force Fr acting on the leg body 2 at the rear side of the human being 1 in the double stance state to each component 
of a total floor reaction force F * t the start of the double stance state (hereinafter referred to as "the floor reaction force 
ratio") and a ratio of time elaps» >d from the start of the double stance state to the double stance period (= elapsed time 
/double stance period; hereina ter referred to as "the double stance time ratio"), then a characteristic correlation exists 

25 between them, and this correle tion is hardly influenced by the moving speed V or the like of the human being 1 . 

[0124] To be more specific, f floor reaction force ratio Frz/Fzs, which denotes a ratio of a component Frz in the Z- 
axis direction (vertical direction > of the floor reaction force Fr acting on the leg body 2 at the rear side to a component 
Fz in the Z-axis direction of the total floor reaction force F at a start of the double stance state (hereinafter denoted by 
a reference character "Fzs"), has a substantially constant correlation shown in Fig. 13(a) with respect to the double 

30 stance time ratio independent! ' of the moving speed V or the like of the human being 1 . Basically, the floor reaction 
force ratio Frz/Fzs decreases f om "1" to "0" with the lapse of time of the double stance state. Furthermore, the floor 
reaction force ratio Frx/Fxs, wl ich denotes a ratio of a component Frx in the X-axis direction (horizontal direction of 
travel of the human being 1 ) of the floor reaction force Fr acting on the leg body 2 at the rear side to a component Fx 
in the X-axis direction of the to al floor reaction force F at a start of the double stance state (hereinafter denoted by a 

35 reference character "Fxs"), ha > a substantially constant correlation shown in Fig. 13(b) with respect to the double 
stance time ratio independent! f of the moving speed V or the like of the human being 1 . As the time of the double 
stance state elapses, the floor 'eaction force ratio Frx/Fxs first increases from "1 ," and then decreases to "0." 
[0125] Accordingly, in the present embodiment, the correlations (the characteristic data) shown in Figs. 13 (a) and 
(b) are stored and retained be orehand in the arithmetic processing unit 16 in the form of data tables or polynomial 

40 functions approximating the coi relations. The processing by the floor reaction force estimating means 38 in the double 
stance state determines an es imated value of the total floor reaction force F and also sequentially determines, for 
each cycle time, the double stance time ratio from a current value of the clocking data of the elapsed time obtained by 
the clocking means 35 and a nost recent value of data of the estimated value of the double stance period that has 
been determined by the doubl > stance period estimating means 37. Then, from the data of the determined double 

45 stance time ratio, the floor reac tion force ratio Frz/Fzs in the Z-axis direction is sequentially determined on the basis 
of the correlation shown in Fig 13(a), and then the floor reaction force ratio Frz/Fzs is multiplied by the component 
Fzx in the Z-axis direction of the total floor reaction force F at a start of the double stance state so as to sequentially 
determine the component Frz in the Z-axis direction of the floor reaction force Fr acting on the leg body 2 at the rear 
side. Similarly, from the obtain. >d data of the double stance time ratio and based on the correlation shown in Fig. 13 

50 (b), the floor reaction force rati* Frx/Fxs in the X-axis direction is sequentially determined, and then the floor reaction 
force ratio Frx/Fxs is multiplied oy the component Fxs in the X-axis direction of the total floor reaction force F at a start 
of the double stance state so as to sequentially determine the component Frx in the X-axis direction of the floor reaction 
force Fr acting on the leg body 2 at the rear side. 

[0126] Furthermore, accordir g to the above expression (3), the floor reaction force Fr= T (Frx, Frz) related to the leg 
55 body 2 at the rear side is subtra :ted from the total floor reaction force F= T (Fx, Fz) determined in each cycle time (vector 
subtraction) so as to sequentia y obtain a floor reaction force Ff= T (Ffx, Ffz)= T (Fx-Frx, Fz-Frz) related to the leg body 
2 on the front side. Thus, the 1 oor reaction forces Fr and Ff of the respective two leg bodies 2 and 2 in the double 
stance state will be sequentially determined. 
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[0127] Next, the arithmetic processing unit 16 carries out processing of the joint moment estimating means 39 to 
determine moments acting on t ie knee joint 1 0 and the hip joint 8 of each leg body 2. This processing is carried out 
on the basis of the so-called inverse dynamic model, using current values of data obtained by the floor reaction force 
estimating means 38. the mears 32 that calculates an acceleration of each portion of a leg body, the means 33 that 

5 calculates an angular acceleral on of each portion of a leg body, the floor reaction force application point estimating 
means 34 and the leg body posture calculating means 28, respectively. The inverse dynamic model is used lo determine 
moments acting on joinls in omer, beginning with a joint closest to a floor reaction force application point, using an 
equation of motion related to translational motions of portions corresponding to the rigid bodies of the human being 1 
and an equation of motion rela ed to rotational motions thereof. In the present embodiment moments acting on the 

10 knee joint 1 0 and the hip joint 8 of each leg body 2 are determined in order 

[0128] More detailedly, referr ng to Fig. 14, regarding the crus 11 of each leg body 2, a force (joint reaction force) 
acting on the ankle 1 2 at a diste i end of the crus 1 1 , a force (joint reaction force) acting on the knee joint 1 0 of the crus 
11 . and a translational acceleration of the center of gravity G2 of the crus 11 are represented by T (F^x, F-,z). T (F 2 x, 
F 2 z) , and T (a 2 x, a 2 z), respectiv ely, according to component notation in the absolute coordinate system Cf, and the 

15 weight of the crus 11 is denote i by m 2 . At this time, the equation of motion related to the translational motion of the 
center of gravity G2 of the crus 11 will be represented by expression (11) given below: 

T (m 2 • a 2 x m 2 • a 2 z) = T (F 1 x-F 2 x, F 1 z-F 2 z-m 2 ■ g) 

20 

therefore, 

T (F 2 x, F 2 z ) 

25 

= (F 1 x-m 2 • a 2 x, F.,z-m 2 • a 2 z-m 2 • g) (11) 



[0129] The acceleration T (a 2 > , a 2 z) of the center of gravity G2 of the crus 11 is determined by the means 32 that 
calculates an acceleration of ef*ch portion of a leg body. The joint reaction force T (F 1 x, F^) acting on the ankle 12 at 
the distal end of the crus 11 is approximately equal to an estimated value of a floor reaction force determined by the 
floor reaction force estimating means 38 on the leg body 2 having the crus 11 . More specifically, in the single stance 
state, if the leg body 2 is in cont act with the ground, then the joint reaction force T (F.,x, F.,z) is the floor reaction force T 
(Fx, Fz) obtained by the above expression (2). If the leg body 2 is a free leg, then " r (F 1 x f F-,z)= T (0, 0). In the double 
stance state, if the leg body 2 i ; the leg body at the rear side in relation to the direction of travel of the human being 
1 , then the joint reaction force 1 (F-,x, F-jZ) is the floor reaction force T (Frx, Frz) determined as described above, using 
the correlations illustrated in Fics. 13 (a) and (b). If the leg body 2 is the leg body at the front side, then the joint reaction 
force T (F 1 x , F.,z) is the floor reac tion force T (Ffx, Ffz) determined as described above according to the above expression 
(3). 

[0130] Hence, the joint reaction force T (F 2 x, F 2 z) acting on the knee joint 10 of each leg body 2 is determined ac- 
cording to the above expressio i (11) from data of the acceleration T (a 2 x, a 2 z) of the center of gravity G2 of the crus 
11 determined by the means 32 that calculates an acceleration of each portion of a leg body, data of the floor reaction 
force (=T(p iX p iZ )) determinec by the floor reaction force estimating means 38, data of the weight m 2 of the crus 11 
determined in advance, and a value of the gravitational acceleration g. 

[0131] Referring to Fig. 14, e moment acting on the ankle 12 at the distal end of the crus 11 is denoted by M 1: a 
moment acting on the knee joir M 0 of the crus 1 1 is denoted by M 2 , a moment of inertia around the center of gravity 
G2 of the crus 11 is denoted b/ l G2 , and an angular acceleration around the center of gravity G2 of the crus 11 is 
denoted by a 2 . In addition, if th > distance between the center of gravity G2 of the crus 11 and the center of the knee 
joint 1 0 is denoted by d 2 , and th 3 distance between the center of gravity G2 of the crus 1 1 and the ankle 1 2 is denoted 
by d 2 ' (=Dd-d 2 ) in association w th Fig. 4, then the equation of motion related to the rotational motion around the center 
of gravity G2 of the crus 11 is represented by the following expression (12): 



1, 32 ■ a 2 = M 1 - M 2 + F.,x - d 2 ' - cosOd - F^z • d 2 * - sinGd 



55 + F 2 x ■ d 2 - cosGd - F 2 z • d 2 - sinGd 

therefore, 
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l/l 2 = M 1 - l G2 • nt 2 + F 1 x • d 2 ' • cosed - F-,7 • d 2 ' • sinfid 



+ F 2 x • d 2 cosGd - F 2 z • d 2 - sinfid (12) 

[01 32] M 1 in expression (12) denotes a moment obtained as a cross product (vector product) of a floor reaction force 
application point vector deterrr ned by the floor reaction force application point estimating means 34 on the leg body 
2 having the cms 11 involved in the expression (12) and a floor reaction force vector determined by the floor reaction 
force estimating means 38 on he leg body 2. a 2 denotes an angular acceleration of the crus 11 determined by the 
means 33 that calculates an ai gular acceleration of each portion of a leg body. 9d denotes a tilt angle of the crus 11 
determined by the leg body posture calculating means 28. T (f 1 x, F.,z) denotes an estimated value of a floor reaction 
force determined by the floor reaction force estimating means 38, as is mentioned before. T (F 2 x, F 2 z) is determined 
by the above expression (1 1 ). " he moment of inertia l G2 is determined and stored in the arithmetic processing unit 1 6 
together with data, including ihd weight m 2 and sizes, of the crus 11 in advance. 

[0133] Hence ; the moment M 2 acting on the knee joint 10 is determined according to the above expression (12), 
using data of an estimated val je of a floor reaction force by the floor reaction force estimating means 38, data of a 
floor reaction force application point vector by the floor reaction force application point estimating means 34, data of 
the angular acceleration a 2 of he crus 11 by the means 33 that calculates an anguiar acceleration of each portion of 
a leg body, data of the tilt angle fid of the crus 11 by the leg body posture calculating means 28, data of a joint reaction 
force T (F 2 x, F 2 z) determined b> the above expression (11), data of the moment of inertia l G2 , size (Dd), and the position 
(d 2 ) of the center of gravity G 2 :>f the crus 11 . which are determined in advance. 

[01 34] The joint moment esti nating means 39 determines the moment M 2 acting on the knee joint 1 0 of the crus 1 1 
as discussed above, then perfc rms the same processing as the calculation processing to determine a moment acting 
on the hip joint 8 of the thigh 9. \ basic concept of the processing is identical to the method for determining the moment 
M 2 of the knee joint 10, so that detailed illustrations and explanation will be omitted; however, an outline will be given 
below. 

[0135] First, a joint reaction lorce T (F 3 x, F 3 z) acting on the hip joint 8 of the thigh 9 is first determined according to 
the following expression (1 3) (e xpression in the same form as that of the above expression (11)) based on the equation 
of motion related to the transla ional motion of the center of gravity G1 (refer to Fig. 4) of the thigh 9: 

f (F 3 x, F 3 z) = T (F 2 x - m 1 - a^, F 2 z - m 1 - a^z - m 1 - g) (13) 

[0136] T (F 2 x, F 2 z) denotes a joint reaction force of the knee joint 10 previously determined by the above expression 
(11). "^a-jx, a^) denotes an ac< eleration (translationai acceleration) in the absolute coordinate system Cf of the center 
of gravity G1 of the thigh 9 determined by the means 32 that calculates an acceleration of each portion of a leg body. 
m 1 denotes the weight of the tl igh 9 determined beforehand, and g denotes a gravitational acceleration. 
[01 37] Then , a moment M 3 a ;ting on the hip joint 8 of the thigh 9 is determined according to the following expression 
(14) (expression having the sa ne form as that of the above expression (12)) based on the equation of motion related 
to the rotational motion around the center of gravity G1 of the thigh 9. 



v1 3 = M 2 -l G1 • a 1 + F 2 x ■ d^ • cosfic - F 2 z • d.,' • sinfic 
45 + F 3 x • d 1 • cosfic - F 3 z • d-, • sinGc (14) 



[0138] M 2 denotes a moment of the knee joint 10 determined according to the above expression (12), T (F 2 x ( F 2 z) 
denotes a joint reaction force o the knee joint 1 0 determined by the above expression (11), T (F 3 x, F 3 z) denotes a joint 
reaction force of the hip joint 8 determined by the above expression (13), l G1 denotes a moment of inertia around the 
center of gravity G1 of the thigh 9 determined beforehand, a 1 denotes an angular acceleration of the thigh 9 determined 
by the means 33 that calculates an angular acceleration of each portion of a leg body and Gc denotes a tilt angle of 
the thigh 9 determined by the k g body posture calculating means 28. Further, d t denotes the distance from the center 
of the hip joint 8 to the center o gravity G1 of the thigh 9 (refer to Fig. 4), and d^ denotes the distance from the center 
of the knee joint 1 0 to the center of gravity G1 of the thigh 9 (Dc- d 1 in Fig. 4), these distances being dependent upon 
the position of the center of gravity G1 and the size (length) of the thigh 9 determined in advance. 
[01 39] The processing explained above is sequentially executed for each cycle time of the arithmetic processing unit 
16 to sequentially estimate in real time the floor reaction forces acting on the respective leg bodies 2, and moments 
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acting on the knee joints 1 0 an i the hip joints 8 of the respective leg bodies 2. 

[0140] Although detailed exp anation will be omitted in the present description, the estimated values of the moments 
of the knee joint 1 0 and the hip oint 8 that have been obtained are used for example, to control an apparatus adapted 
to aid the human being 1 in walking (an apparatus that includes an electric motor or the like capable of supplying 
auxiliary torque to the knee joirts 1 0 and the hip joints 8). 

[0141] Time-dependent charge in an estimated value of a floor reaction force (an absolute value of the estimated 
value of the floor reacLion force, to be more specific) determined by the processing performed by the arithmetic process- 
ing unit 16 described above is ill jstrated by the solid lines in Fig. 15. Furthermore, time-dependent changes in estimated 
values of moments on the knee joints 1 0 and the hip joints 8 determined by the processing performed by the arithmetic 
processing unit 16 are iilustrat id by the solid lines in Fig. 16. Fig. 15 and Fig. 16 illustrate cases where the human 
being 1 walks on a level ground at a substantially constant speed. In this case, in Fig. 15, a comparative example 
(equivalent to a true value of th<i floor reaction force) in which floor reaction forces have been actually measured using 
a force meter or the like is also shown by virtual lines, in Fig. 16, a comparative example (equivalent to true values of 
the moments on the knee joint 1 0 and the hip joint 8) in which the moments on the knee joint 1 0 and the hip joint 8 
have been actually measured using a torque meter or the like is also shown by virtual lines. 

[0142] As is obvious from F g. 15, the present embodiment allows highly accurate estimated values of the floor 
reaction forces to be obtained. Moreover, the present embodiment allows the moments on the knee joint 10 and the 
hip joint 8 to be estimated with 'elatively high accuracy, as shown in Fig. 1 6 by using the estimated values of the floor 
reaction forces. 

[0143] Thus, according to the present embodiment, it is possible to easily estimate, in real time, floor reaction forces 
acting on the respective leg bo lies 2 and moments acting on the hip joints 8 and the knee joints 1 0 of the respective 
leg bodies 2 by using relatively small and light-weight sensors : such as the angle sensors 22 and 23 attached to the 
hip joint 8 and hip joint 8, gyre sensors 14 and 19 and accelerometers 15, 20 and 21 attached to the torso 5. This 
obviates the need for providing the leg bodies 2 with sensors that interfere with walking of the human being 1 or add 
load to motions of the leg bod 3S 2. Moreover the estimation can be achieved with relatively high accuracy without 
depending on the moving speed V or the like. 

[0144] In the embodiment e> plained above, during the processing performed by the leg body motion determining 
means 24, when the time elap>ed from a start of the double stance state reaches an estimated value of the double 
stance period, an end of the doi ble stance state and a start of the single stance state were determined. As an alternative 
example, however an end of the double stance state and a start of the single stance state may be determined as 
follows. An absolute value of a f oor reaction force Fr = \(Frx 2 4-Frz 2 ) determined for each cycle time by the floor reaction 
force estimating means 38 on the leg body 2 at the rear side of the human being 1 (the leg body 2 that leaves a floor 
upon an end of the double stance state) in the double stance state is sequentially compared with a predetermined 
threshold value (a positive value of almost "0") that is set beforehand. When an absolute value of the floor reaction 
force Fr reduces down to the threshold value or less (when the absolute value reaches almost. "0"), it is determined 
that the double stance state has ended and the single stance state has begun. This also permits accurate determination 
to be achieved. 

[0145] In the present embod ment, the explanation has been given, taking case where the present invention has 
been applied to the human bei lg 1 as an example. The present invention, however, can be applied also to a bipedal 
walking robot as a bipedal walk ng body. Some bipedal walking robots are constructed to have their waists and chests 
combined into one. In such a c ise, it is possible to attach a gyro sensor and a longitudinal accelerometer only to one 
of the waist and the chest to e; timate floor reaction forces and moments on joints of leg bodies in the same manner 
as that in the present embodim snt, Furthermore, in a bipedal walking robot, the bending angles of hip joints and knee 
joints can be alternatively dete mined by control amounts of a controller for actuators of the joints. 
[0146] Furthermore, in the pr isent embodiment, detection data of the waist vertical accelerometer 21 has been used 
as it is to determine a motional >tate of the leg body 2. In place of the detection data, however a value of, for example, 
a component in a vertical direct on (the Z-axis direction) of the acceleration a 0 of the waist 3 in the absolute coordinate 
system Cf that is determined b ' the reference acceleration measuring means 27 may be used. 

INDUSTRIAL APPLICABILITY 

[0147] As described above, 1 ie present invention is useful for determining floor reaction forces and joint moments 
acting on leg bodies of a mobile body when aiding a bipedal walking body, such as a human being or a robot, in walking 
or conducting walking control tl lereof . 



22 



EP1 424 172 A1 



Claims 

1 . A method of estimating flo< >r reaction forces acting on respective leg bodies of a bipedal walking body, comprising: 

5 a first step for determi ling whether a motion state of leg bodies of the bipedal walking body is a single stance 

slate wherein only ono o\ the leg bodies is in conlacl with the ground or a double stance state wherein both 
leg bodies are in contact with the ground; 

a second step for sequentially determining positions of the center of gravity of the bipedal walking body while 
also sequentially detei mining accelerations of the center of gravity in an absolute coordinate system fixed with 

10 respect to the ground, using time-series data of the positions of the center of gravity: 

a third step for sequentially determining estimated value of total floor reaction force on the basis of an equation 
of motion of the cente s of gravity represented by a weight of the bipedal walking body, gravitational acceler- 
ations, the accelerations of the center of gravity : and total floor reaction force, which is a resultant force of the 
floor reaction forces acting on the respective leg bodies; 

15 a fourth step for seque ntially measuring time elapse from a start of the double stance state until an end thereof 

each time the double stance state begins; 

a fifth step for measuring a moving speed of the bipedal walking body at least on or before each double stance 
state begins; 

a step of sequentially determining estimated values of the total floor reaction force, when the bipedal walking 
20 body is in the single stance state, as estimate values of floor reaction forces acting on a single leg body in 

contact with the grourd; and 

a step of sequentially determining estimated values of floor reaction forces acting on one of the two leg bodies, 
when the bipedal walking body is in the double stance state, the one leg body being located at the rear side 
in relation to the direction of travel of the bipedal walking body, on the basis of characteristic data pre-estab- 
25 lished as indicative of iharacteristics of changes in floor reaction force acting on the one leg body with respect 

to the elapsed time of he double stance state and moving speed of the bipedal walking body, and sequentially 
determining estimatec values of the floor reaction forces acting on the other leg body by subtracting the de- 
termined estimated v* lues of the floor reaction forces of the one leg body from the estimated values of the 
total floor reaction for< e. 

30 

2. The method according to < ;laim 1 , wherein 

the characteristic da a is data indicating a relationship between a ratio of a floor reaction force of the one leg 
body to the total floor react on force at a start of the double stance state and a ratio of the elapsed time to a duration 
from a start to an end of tr e double stance state 

35 a duration of the doLble stance state is estimated from a measured value of the moving speed on the basis 

of a pre-established corre ation between the moving speed of the bipedal walking body and the duration of the 
double stance state, and e: itimated values of floor reaction forces acting on the one leg are sequentially determined 
on the basis of the estima :ed value of the duration of the double stance state, a measured value of the elapsed 
time, an estimated value of the total floor reaction force at the start of the double stance state, and the characteristic 

^0 data. 

3. The method according to < laim 1 , further comprising the steps of: 

measuring a tilt angle a crus under a knee joint of each leg body of the bipedal walking body and a tilt angle 
45 of a thigh between a r ip joint and a knee joint of the leg body at a start of each double stance state; 

calculating, at a start of each double stance state, a shift amount of a position of a bottom end portion of the 
crus of the leg body with respect to the hip joint of the leg body existing at the rear side in relation to the 
direction of travel of tue bipedal walking body, the shift taking place in the direction of travel of the bipedal 
walking body from the start of the preceding double stance state, on the basis of measured values of tilt angles 
50 of the thigh and the crus of the leg body and pre-acquired sizes of the thigh and the crus of the leg body each 

time the double stanco state begins; and 

measuring the time elapsed from a start of each double stance state to a start of the next double stance state 
as elapsed time for or e step, 

55 wherein in the fifth step, each time the double stance state begins, the shift amount calculated at the start is 

divided by the one-step elapsed time measured from a start of the preceding double stance state to a start of the 
present double stance sta e so as to obtain a measured value of the moving speed. 
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4. The method according to c aim 1 . further comprising the steps of: 

sequentially measuring a vertical acceleration of a lower portion of a torso, which is adjacent to a hip joint, the 
torso being supported :>n the two leg bodies through the intermediary of hip joints of the leg bodies, 

5 

wherein a motion stcLe of the bipedal walking body is determined in the first step as the beginning of the 
double stance slate and tra end of the single stance state when the vertical acceleration of the lower portion of 
the torso increases to a pr 3determined threshold value or more, and as the end of the double stance state and 
the beginning of the single stance state when an estimated value of the floor reaction force acting on the leg body 
10 at the rear side in relation tc the direction of travel of the bipedal walking body in the double stance state decreases 

to a predetermined threshold value or loss. 

5. The method according to c aim 2 comprising the steps of: 

15 measuring a vertical acceleration of a lower portion of a torso, which is adjacent to a hip joint, the torso being 

supported on the two I ?g bodies through the intermediary of hip joints of the leg bodies, 

wherein a motion stete of the bipedal walking body is determined in the first step as the beginning of the 
double stance state and the end of the single stance state when the vertical acceleration of the lower portion of 
20 the torso increases to a predetermined threshold value or more, and as the end of the double stance state and 

the beginning of the single itance state when a measured value of time elapsed from the start of the double stance 
state reaches an estimates value of a duration of the double stance state. 
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6. The method according to c aim t . comprising the steps of: 

sequentially measuring tilt angles of a torso supported on the two leg bodies through the intermediary of hip 
joints of the respective leg bodies, bending angles of at least hip joints and knee joints of the respective leg 
bodies, and accelerations in the absolute coordinate system of a predetermined reference point of the bipedal 
walking body, 



wherein in the secon J step, positions of the center of gravity of the bipedal walking body with respect to the 
reference point are sequen :ially determined on the basis of tilt angles of the torso, bending angles of the hip joints 
and the knee joints, a rigid body link model representing the bipedal walking body in the form of a link assembly 
of a plurality of rigid bodies , pre-acquired weights of individual portions of the bipedal walking body, which corre- 

35 spond to individual rigid bo iies of the rigid body link model, and the pre-acquired positions of the centers of gravity 

of the portions correspondi ig to rigid bodies in the individual portions corresponding to rigid bodies, accelerations 
of the center of gravity with respect to the reference point are sequentially determined on the basis of time-series 
data of the positions of the center of gravity, and accelerations of the center of gravity in the absolute coordinate 
system are determined fro n the accelerations of the center of gravity with respect to the reference point and the 

40 accelerations of the referei ice point in the absolute coordinate system. 

7. The method according to c aim 6. wherein the reference point is set in the torso. 

8. The method according to ;laim 6, wherein the torso has a waist connected to the two leg bodies through the 
45 intermediary of hip joints, ind a chest located on the waist such that it. can be tilted with respect to the waist, 

wherein tilt anglers of the tc -so used to determine a position of the center of gravity are tilt angles of the waist and 
the chest, respectively. 

9. The method according to c aim 8, wherein the rigid body link model is a model in which cruses under knee joints 
50 of the respective leg bodie: , thighs between the knee joints and the hip joints, the waist, and a body that includes 

the chest located on the upper side of the waist of the bipedal walking body are respectively represented in the 
form of rigid bodies. 



10. A method of estimating mo nents acting on at least one joint of each leg body of the bipedal walking body by using 
estimated values of floor reaction forces related to each leg body that have been sequentially determined according 
to the method of estimating floor reactions of a bipedal walking body described in any one of Claims 1 to 5, com- 
prising the steps of: 



24 



NSDOCID: <EP _ 14241 72A1..I ..> 



EP 1 424 172 A1 



sequentially measuring tilt angles of a torso supported on the two leg bodies through the intermediary of hip 
joints of the respective leg bodies, bending angles of at least hip joints and knee joints of the respective leg 
bodies ; and accelerations of a pre-established reference point of the bipedal walking body in the absolute 
coordinate system; 

sequentially determinir g tilt angles of portions corresponding to rigid bodies of the bipedal walking body that 
are associated with respective rigid bodies of a rigid body link model on the basis of tilt angles of the torso, 
bending angles of the lespective hip joints and the knee joints of the leg bodies, and the rigid body link model 
representing the bipedal walking body in the form of a link assembly of a plurality of rigid bodies; 
sequentially determinir g positions of centers of gravity of the portions corresponding to rigid bodies in relation 
to the reference point c n the basis of tilt angles of the portions corresponding to the rigid bodies, pre-obtained 
weights of the portions corresponding to the rigid bodies, and pre-obtained positions of centers of gravity of 
the portions corresponding to the rigid bodies in the individual portions corresponding to the rigid bodies, and 
sequentially determinir g accelerations of the centers of gravity of the portions corresponding to the rigid bodies 
with respect to the refe rence point on the basis of time-series data of the positions of centers of gravity of the 
portions corresponding to the rigid bodies; 

sequentially determinir g accelerations of the centers of gravity of the portions corresponding to the rigid bodies 
in the absolute coordin ite system from the accelerations of the centers of gravity of the portions corresponding 
to the rigid bodies in re ation to the reference point and the accelerations of the reference point in the absolute 
coordinate system: 

sequentially determinii g angular accelerations of the portions corresponding to the rigid bodies on the basis 
of time-series data of t ie tilt angles of the portions corresponding to the rigid bodies; and 
sequentially determining estimated positions of points of application of floor reaction forces of the leg bodies 
in the bipedal walking >ody on the basis of at least eithertilt angles of thighs of the leg bodies as the portions 
corresponding to the ri; fid bodies of the bipedal walking body or bending angles of knee joints of the leg bodies, 

wherein moments ac ing on at least one joint of the leg bodies of the bipedal walking body are estimated on 
the basis of an inverse dyne mic model by using the estimated values of the floor reaction forces, estimated positions 
of points of application of loor reaction forces, the accelerations of the centers of gravity of the portions corre- 
sponding to the rigid bodie ; and the angular accelerations of the portions corresponding to the rigid bodies in the 
absolute coordinate systen, the tilt angles of the portions corresponding to the rigid bodies, the pre-acquired 
weights and sizes of the p >rtions corresponding to the rigid bodies, the pre-acquired positions of the centers of 
gravity of the portions corre spondmg to the rigid bodies in the respective portions corresponding to the rigid bodies, 
and pre-acquired inertia! moments of the portions corresponding to the rigid bodies. 

A method of estimating mo nents acting on at least one joint of each leg body of the bipedal walking body by using 
estimated values of floor re iction forces related to each leg body that have been sequentially determined according 
to the method of estimating floor reactions of a bipedal walking body described in any one of Claims 6 to 9, com- 
prising the steps of: 

sequentially determinir g tilt angles in the absolute coordinate system of respective portions corresponding to 
rigid bodies of the bipedal walking body that are associated with respective rigid bodies of a rigid body link 
model on the basis of :ilt angles of the torso, bending angles of the hip joints and the knee joints of the leg 
bodies, and the rigid b )dy link model; 

sequentially determinir g positions of centers of gravity of the portions corresponding to rigid bodies in relation 
to the reference point c n the basis of tilt angles of the portions corresponding to the rigid bodies, pre-obtained 
weights of the portions corresponding to the rigid bodies, and positions of centers of gravity of the portions 
corresponding to the ri jid bodies in the individual portions corresponding to the rigid bodies, and sequentially 
determining accelerate ns of the centers of gravity of the portions corresponding to the rigid bodies with respect 
to the reference point Dn the basis of time-series data of the positions of centers of gravity of the portions 
corresponding to the ri }id bodies; 

sequentially determinir g accelerations of the centers of gravity of the portions corresponding to the rigid bodies 
in the absolute coordin ite system from the accelerations of the centers of gravity of the portions corresponding 
to the rigid bodies in re ation to the reference point and the accelerations of the reference point in the absolute 
coordinate system: 

sequentially determinir g angular accelerations of the portions corresponding to the rigid bodies on the basis 
of time-series data of tne tilt angles of the portions corresponding to the rigid bodies; and 
sequentially determinir g estimated positions of points of application of floor reaction forces of the leg bodies 
in the bipedal walking body on the basis of at least tilt angles of thighs of the leg bodies as the portions 
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corresponding to the ricid bodies of thebipedal walking body or bending angles of knee joints of the leg bodies, 

wherein moments act ng on at least one joint of the teg bodies of the bipedal walking body are estimated on 
the basis of an inverse dyna nic model by using the estimated values of the floor reaction forces, estimated positions 

5 of points of application of f oor reaction forces, the accelerations of the centers of gravity of the portions corre- 

sponding to the rigid bodiei and the angular accelerations of the portions corresponding to the rigid bodies in Ihe 
absolute coordinate system, the Lilt angles of the portions corresponding to the rigid bodies, the pre-acquired 
weights and sizes of the portions corresponding to the rigid bodies, the pre-acquired positions of the centers of 
gravity of the portions corre sponding to the rigid bodies in the respective portions corresponding to the rigid bodies, 

10 and pre-acquired inertia! moments of the portions corresponding to the rigid bodies. 
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FIG. 1 (a) 
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FIG. 2 
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FIG. 4 
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